Page 34 - ipst-sensorlab
P. 34
l ¤ÁÙ Í× ¡Ò÷´ÅͧáÅÐ㪧 Ò¹µÇÑ µÃǨ¨ºÑ ¢Í§ª´Ø ¡ÅÍ §ÊÁͧ¡Å IPST-MicroBOX
ã¹â»Ãá¡ÃÁ¹¨Õé зÒí §Ò¹Ç¹ÍÒ ¹¤Ò ¨Ò¡¾Íõ PA2 Í¹Ñ à»¹ ¤Ò ·äÕè ´¨ Ò¡¡ÒõÃǨ¨ºÑ áʧÊÐ·Í ¹áÅÇ ¼Ò ¹
¡ÒÃá»Å§à»¹ ¢Í ÁÅÙ ´¨Ô µÔ ÍÅ´Ç ÂâÁ´ÅÙ á»Å§ÊÑ Ò³ÀÒÂã¹äÁâ¤Ã¤Í¹â·ÃÅàÅÍà ¨Ò¡¹¹Ñé ¹Òí ¤Ò ·äÕè ´¹ äÕé »áÊ´§
¼Å·Õè LED 7 ÊÇ ¹º¹á¼§Ç§¨Ã DSP-4 ¾ÃÍ Á¡¹Ñ ¹¹éÑ ¨ÐÁ¡Õ ÒõÃǨÊͺªÇ §¢Íºà¢µ¢Í§¢Í ÁÅÙ ·§éÑ ´Ò ¹Ê§Ù áÅеÒíè
â´ÂÁàÕ §Íè× ¹ä¢ã¹¡ÒõÃǨÊͺ 4 à§Íè× ¹ä¢´§Ñ ¹Õé
1. à§Íè× ¹ä¢µÃǨÊÍºÊ´Õ Òí if(reflect >= BLACK_MIN && reflect <= BLACK_MAX)
¶Ò ¤Ò ·ÍèÕ Ò ¹ä´Á ¤Õ Ò µ§Ñé áµ 442-2 ¶§Ö 447+2 㪵 Ãá¡Ð AND ໹ µÇÑ µÃǨÊͺ«§èÖ ËÁÒÂ
¶§Ö µÍ §à»¹ ¨Ã§Ô ·§éÑ 2à§Íè× ¹ä¢ÂÍ Â¨§Ö ¨Ð·Òí ãËà §Í×è ¹ä¢à»¹ ¨Ã§Ô áÅеͺʹͧ´Ç ¡ÒâºÑ àÊÂÕ § µ´êÔ áÅÇ Ê§èÑ ãË LED
µÒí á˹§ 1 µ´Ô ÊÇÒ § à¾Í×è ᨧ àµÍ× ¹ÇÒ µÃǨ¾ºÊ´Õ Òí áÅÇ
2. à§Íè× ¹ä¢µÃǨÊͺÊàÕ ¢ÂÕ Ç else if(reflect >= GREEN_MIN && reflect <= GREEN_MAX)
à§Íè× ¹ä¢¹¨Õé зÒí ¡ÒõÃǨÊͺµÍ ¶Ò à§Íè× ¹ä¢µÃǨÊÍºÊ´Õ Òí ໹ à·¨ç â´Â¶Ò ¤Ò ·ÍèÕ Ò ¹ä´¨ Ò¡
ἧǧ¨ÃµÃǨ¨ºÑ áʧÊÐ·Í ¹Á¤Õ Ò µ§éÑ áµ 537-2 (ËÃÍ× 535) ¶§Ö 546+2 (ËÃÍ× 548) ¨Ð·Òí ãËà §Íè× ¹ä¢à»¹ ¨Ã§Ô áÅÐ
µÍºÊ¹Í§´Ç ¡ÒâºÑ àÊÂÕ § µ´Ôê áÅÇ Ê§èÑ ãË LED µÒí á˹§ 2 µ´Ô ÊÇÒ § à¾Í×è ᨧ àµÍ× ¹ÇÒ µÃǨ¾ºÊàÕ ¢ÂÕ ÇáÅÇ
3. à§Í×è ¹ä¢µÃǨÊÍºÊ¢Õ ÒÇ else if(reflect >= WHITE_MIN && reflect <= WHITE_MAX)
¨Ð·Òí ¡ÒõÃǨÊͺà§Í×è ¹ä¢¹àÕé ÁÍ×è à§Íè× ¹ä¢µÃǨÊͺÊàÕ ¢ÂÕ Ç໹ à·¨ç â´Â¶Ò ¤Ò ·ÍÕè Ò ¹ä´
¨Ò¡á¼§Ç§¨ÃµÃǨ¨ºÑ áʧÊÐ·Í ¹Á¤Õ Ò µ§éÑ áµ 747-2 (ËÃÍ× 745) ¶§Ö 756+2 (ËÃÍ× 758) ¨Ð·Òí ãËà §Í×è ¹ä¢à»¹ ¨Ã§Ô
áÅеͺʹͧ´Ç ¡ÒâºÑ àÊÂÕ § µ´êÔ áÅÇ Ê§èÑ ãË LED µÒí á˹§ 3 µ´Ô ÊÇÒ § à¾Íè× á¨§ àµÍ× ¹ÇÒ µÃǨ¾ºÊ¢Õ ÒÇ
áÅÇ
4. à§Íè× ¹ä¢º§Ñ ¤ºÑ àÁÍ×è ·§Ñé 3 à§Íè× ¹ä¢áá໹ à·¨ç else
à§Íè× ¹ä¢¹àéÕ »¹ à§Í×è ¹ä¢º§Ñ ¤ºÑ àÁÍè× ¡ÒõÃǨÊÍºÊ·Õ §Ñé 3 Ê¡Õ Í ¹Ë¹Ò ¹àÕé »¹ à·¨ç ·§éÑ ËÁ´ µÍº
ʹͧ´Ç ¡ÒôºÑ LED ·§éÑ 8 ´Ç§à¾Íè× á¨§ ÇÒ äÁ¾ ºÊ¢Õ Í§ÇµÑ ¶àØ »Ò ËÁÒÂ
â»Ãá¡ÃÁ·Õè A3-2 : ä¿Å ReflectTest02.c â»Ãá¡ÃÁÀÒÉÒ C ÊÒí ËÃºÑ ·´Êͺ¡ÒõÃǨ¨ºÑ ÇµÑ ¶ÊØ àÕ »Ò ËÁÒÂ
¢Í§ª´Ø ¡ÅÍ §ÊÁͧ¡Å IPST-MicroBOX (¨º)
ã¹â»Ãá¡ÃÁ¹¨Õé зÒí §Ò¹Ç¹ÍÒ ¹¤Ò ¨Ò¡¾Íõ PA2 Í¹Ñ à»¹ ¤Ò ·äÕè ´¨ Ò¡¡ÒõÃǨ¨ºÑ áʧÊÐ·Í ¹áÅÇ ¼Ò ¹
¡ÒÃá»Å§à»¹ ¢Í ÁÅÙ ´¨Ô µÔ ÍÅ´Ç ÂâÁ´ÅÙ á»Å§ÊÑ Ò³ÀÒÂã¹äÁâ¤Ã¤Í¹â·ÃÅàÅÍà ¨Ò¡¹¹Ñé ¹Òí ¤Ò ·äÕè ´¹ äÕé »áÊ´§
¼Å·Õè LED 7 ÊÇ ¹º¹á¼§Ç§¨Ã DSP-4 ¾ÃÍ Á¡¹Ñ ¹¹éÑ ¨ÐÁ¡Õ ÒõÃǨÊͺªÇ §¢Íºà¢µ¢Í§¢Í ÁÅÙ ·§éÑ ´Ò ¹Ê§Ù áÅеÒíè
â´ÂÁàÕ §Íè× ¹ä¢ã¹¡ÒõÃǨÊͺ 4 à§Íè× ¹ä¢´§Ñ ¹Õé
1. à§Íè× ¹ä¢µÃǨÊÍºÊ´Õ Òí if(reflect >= BLACK_MIN && reflect <= BLACK_MAX)
¶Ò ¤Ò ·ÍèÕ Ò ¹ä´Á ¤Õ Ò µ§Ñé áµ 442-2 ¶§Ö 447+2 㪵 Ãá¡Ð AND ໹ µÇÑ µÃǨÊͺ«§èÖ ËÁÒÂ
¶§Ö µÍ §à»¹ ¨Ã§Ô ·§éÑ 2à§Íè× ¹ä¢ÂÍ Â¨§Ö ¨Ð·Òí ãËà §Í×è ¹ä¢à»¹ ¨Ã§Ô áÅеͺʹͧ´Ç ¡ÒâºÑ àÊÂÕ § µ´êÔ áÅÇ Ê§èÑ ãË LED
µÒí á˹§ 1 µ´Ô ÊÇÒ § à¾Í×è ᨧ àµÍ× ¹ÇÒ µÃǨ¾ºÊ´Õ Òí áÅÇ
2. à§Íè× ¹ä¢µÃǨÊͺÊàÕ ¢ÂÕ Ç else if(reflect >= GREEN_MIN && reflect <= GREEN_MAX)
à§Íè× ¹ä¢¹¨Õé зÒí ¡ÒõÃǨÊͺµÍ ¶Ò à§Íè× ¹ä¢µÃǨÊÍºÊ´Õ Òí ໹ à·¨ç â´Â¶Ò ¤Ò ·ÍèÕ Ò ¹ä´¨ Ò¡
ἧǧ¨ÃµÃǨ¨ºÑ áʧÊÐ·Í ¹Á¤Õ Ò µ§éÑ áµ 537-2 (ËÃÍ× 535) ¶§Ö 546+2 (ËÃÍ× 548) ¨Ð·Òí ãËà §Íè× ¹ä¢à»¹ ¨Ã§Ô áÅÐ
µÍºÊ¹Í§´Ç ¡ÒâºÑ àÊÂÕ § µ´Ôê áÅÇ Ê§èÑ ãË LED µÒí á˹§ 2 µ´Ô ÊÇÒ § à¾Í×è ᨧ àµÍ× ¹ÇÒ µÃǨ¾ºÊàÕ ¢ÂÕ ÇáÅÇ
3. à§Í×è ¹ä¢µÃǨÊÍºÊ¢Õ ÒÇ else if(reflect >= WHITE_MIN && reflect <= WHITE_MAX)
¨Ð·Òí ¡ÒõÃǨÊͺà§Í×è ¹ä¢¹àÕé ÁÍ×è à§Íè× ¹ä¢µÃǨÊͺÊàÕ ¢ÂÕ Ç໹ à·¨ç â´Â¶Ò ¤Ò ·ÍÕè Ò ¹ä´
¨Ò¡á¼§Ç§¨ÃµÃǨ¨ºÑ áʧÊÐ·Í ¹Á¤Õ Ò µ§éÑ áµ 747-2 (ËÃÍ× 745) ¶§Ö 756+2 (ËÃÍ× 758) ¨Ð·Òí ãËà §Í×è ¹ä¢à»¹ ¨Ã§Ô
áÅеͺʹͧ´Ç ¡ÒâºÑ àÊÂÕ § µ´êÔ áÅÇ Ê§èÑ ãË LED µÒí á˹§ 3 µ´Ô ÊÇÒ § à¾Íè× á¨§ àµÍ× ¹ÇÒ µÃǨ¾ºÊ¢Õ ÒÇ
áÅÇ
4. à§Íè× ¹ä¢º§Ñ ¤ºÑ àÁÍ×è ·§Ñé 3 à§Íè× ¹ä¢áá໹ à·¨ç else
à§Íè× ¹ä¢¹àéÕ »¹ à§Í×è ¹ä¢º§Ñ ¤ºÑ àÁÍè× ¡ÒõÃǨÊÍºÊ·Õ §Ñé 3 Ê¡Õ Í ¹Ë¹Ò ¹àÕé »¹ à·¨ç ·§éÑ ËÁ´ µÍº
ʹͧ´Ç ¡ÒôºÑ LED ·§éÑ 8 ´Ç§à¾Íè× á¨§ ÇÒ äÁ¾ ºÊ¢Õ Í§ÇµÑ ¶àØ »Ò ËÁÒÂ
â»Ãá¡ÃÁ·Õè A3-2 : ä¿Å ReflectTest02.c â»Ãá¡ÃÁÀÒÉÒ C ÊÒí ËÃºÑ ·´Êͺ¡ÒõÃǨ¨ºÑ ÇµÑ ¶ÊØ àÕ »Ò ËÁÒÂ
¢Í§ª´Ø ¡ÅÍ §ÊÁͧ¡Å IPST-MicroBOX (¨º)