ÎïÌå¡£²âËÙÄ£¿éµÄ²ÛÐͲ»ÒªÓÐÕϰÎģ¿é½ÓÉϵçÔ´ºó£¬OUTÊä³ö¶Ëµçѹ½Ó½üµçÔ´µçѹ£¬D1ָʾµÆ²»ÁÁ£¬µ±ÓôóÓÚ2MMµÄ²»Í¸Ã÷ÎïÌåͨ¹ý²ÛÐ͹âµç£¨ÂëÅ̵ĸô¶Ï£©£¬OUTÊä³ö¶ËµçѹΪ¸ßµçƽ£¬D1ָʾ²»ÁÁ£¨±íʾÒѾ¼ì²âµ½ÎïÌ壩¡£µ±²ÛÐÍûÓÐÕÚµ²ÓÐ͸Ã÷ÎïÌåͨ¹ý£¨ÂëÅ̵Äɾ¸ñ£©£¬OUTÊä³ö¶ËµçѹΪµÍµçƽ£¬D1ָʾÁÁ£¨±íʾÎÞÎïÌ壩¡£
íÀÂëÅÌÉÏÓоùÔÈ·Ö²¼µÄ20ɾ¸ñ£¬°Ñ360¶Èƽ¾ù·ÖΪ18¶È/¸ñµÄ20С¸ñ¡£µ¥Æ¬»ú¿ØÖƲâËÙÄ£¿é·¢³öÒ»¶¨ÆµÂʵĹ⣬µ±É¾¸ñµÄ¿ÕµµÓйâÏßͨ¹ýʱ£¬½ÓÊÕ×°Öüì²âµ½¹Ì¶¨ÆµÂʵĹâÏߣ¬µ¥Æ¬»ú¼ì²âµ½µÄÊä³öÐźÅΪ0£¬µ±É¾¸ñµÄ±ß¿òÕÚµ²¹âÏßʱ£¬½ÓÊÕ×°Öüì²â²»µ½¹âÏߣ¬µ¥Æ¬»ú¼ì²âµ½µÄÊä³öÐźÅΪ1£¬µ¥Æ¬»úͨ¹ý¶Ô²âËÙÐÅºÅ¸ßµçÆ½¼ÆÊý£¬´Ó¶ø¼ÆËã³öÂëÅÌËÙ¶ÈÓëÐÐ×ß¾àÀë¡£
µ¥Æ¬»úµÄ¶¨Ê±Æ÷Öжϣ¬²»¶Ï²úÉúÂö³å£¬¸ù¾ÝÒ»¸öÂö³åµÄ¸ßµçƽÐźţ¬¿ÉÖªÔÚÒ»¶¨µÄÂö³åƵÂÊfÏ£¬»ñÈ¡1sÄÚÂÖ×Óת¹ýµÄÕ¤¸ñÊýn,ÓÉÓÚÂÖ×ÓÖ±¾¶d ÒÑÖª£¬Ôò1sÄÚÂÖ×Ó×ß¹ýµÄ¾àÀëÊÇS=ndf¦Ð/20£¬ÔòÂÖ×ÓµÄËÙ¶È¿ÉÓÃÊýÂë¹ÜÏÔʾ³öÀ´¡£
2.2.3Ö±Á÷µç»úС³µËÄ·Ѱ¼£¿ØÖÆÔÀí
·¢Éä¹Ü·¢Éä³öºìÍâÏߣ¬Èç¹û̽ͷ²»ÔÚºÚÏßÉÏ£¬Ôò·´É仨À´µÄ¹â±»½ÓÊն˽ÓÊÕ£¬½ÓÊն˵¼Í¨£¬Ôò10kµç×èR2µÄÊä³ö¶ËOUT½ÓµØ£¬µçѹΪ0£»·¢Éä¹Ü·¢Éä³öºìÍâÏߣ¬Èç¹û̽ͷÔÚºÚÏßÉÏ£¬Ôò·´Éä¹â±»ºÚ´øÎüÊÕ£¬½ÓÊÕ¶ËûÓÐÊÕµ½Ðźţ¬²»µ¼Í¨£¬Ôò10Kµç×èR2µÄÊä³ö¶ËOUTµçѹΪVcc¡£Ñ°¼£Á÷³ÌͼÈçͼ2-2Ëùʾ¡£
δ¼ì²âµ½ºÚÏß ×ó²à¼ì²âµ½ºÚÓÒ²à¼ì²âµ½ºÚÖ±×ß×óת ÓÒת
ͼ2-2 Ö±Á÷С³µËÄ·Ѱ¼£Á÷³Ìͼ
2.2.4Ö±Á÷µç»úС³µ±ÜÕÏ¿ØÖÆÔÀí
±ÜÕϹ¦ÄÜÊÇС³µÔÚ½øÐеĹý³ÌÖÐ×Ô¶¯¶ã±ÜÕϰ²¢Ç°½øµÄ¹¦ÄÜ£¬ÊµÏÖ±ÜÕϹ¦ÄܵĴ«¸ÐÆ÷Ö÷ÒªÊǺìÍâ´«¸ÐÆ÷¡£
ºìÍâ·´Éäʽ´«¸ÐÆ÷ÊǼ¯·¢ÉäÓë½ÓÊÕÓÚÒ»ÌåµÄ¹âµç´«¸ÐÆ÷£¬¾ßÓÐ̽²â¾àÀëÔ¶£¨×îÔ¶¿É´ïµ½80cm£©¡¢Êܿɼû¹â¸ÉÈÅС¡¢Ìå»ýС¡¢¹¦ºÄµÍ¡¢Ó¦Ó÷½±ãµÈÌØµã¡£¶øÇÒËü¼ì²âÕϰÎïµÄ¾àÀ룬¿ÉÒÔ¸ù¾Ýʵ¼ÊÒªÇó£¬Í¨¹ýβ²¿µÄµçλÆ÷ÐýÅ¥£¬½øÐе÷½Ú£¬
- 14 -
·Ç³£ÊÊÓÃÓÚС³µ±ÜÕÏ¡£
Èý¸öºìÍâ´«¸ÐÆ÷£¬·Ö±ð·ÅÖÃÔÚ³µÉíµÄÕýǰ·½¡¢×óǰ·½ºÍÓÒǰ·½£¬Ë®Æ½»¥³É60¡ã½Ç¡£µ±Èý¸öÖеÄÒ»¸ö»ò¶à¸ö£¨ÕϰÎï½Ï´ó£©½ÓÊÕ²¿·ÖµÄ´«¸ÐÆ÷£¬¾ÍÄܸù¾Ý·´É仨À´µÄºìÍâÏß½øÐÐ×Ô¶¯µ÷Õû£¬´Ó¶øÊ¹Ð¡³µµÄÔËÐй켣´ïµ½×Ô¶¯±ÜÕϵÄÄ¿µÄ¡£ ÒÔÒ»¸öºìÍ⿪¹Ø´«¸ÐÆ÷ΪÀý£¬¹âµç¿ª¹ØÐźÅÊä³ö½Ó¿ÚÁ¬½Óµ¥Æ¬»úµÄP0.0¿Ú£¬µ±¼ì²âµ½ÕϰÎïʱ£¬¹âµç¿ª¹ØÊä³öµÍµçƽ£¬ÐźÅΪ0£¬Ã»ÓÐÕϰÎïʱ£¬¹âµç¿ª¹ØÊä³ö¸ßµçƽ£¬ÐźÅΪ1£¬Ð¡³µµÄÔËÐÐÂß¼²Î¿¼±í2-2£¬µÃµ½Ð¡³µ»ù±¾ÔËÐÐÂß¼Èçͼ2-3¡£
±í2-2 µ¥¸öºìÍâ´«¸ÐÆ÷±ÜÕϵĻù±¾ÔËÐÐÂß¼ P0.0ÐźŠ¼ì²â״̬ 1 0 ÓÐÕϰ ÎÞÕϰ ×óµç»ú¿ØÖÆ P1.3 0 1 1 0 P1.2 1 0 1 1
ÓÒµç»ú¿ØÖÆ P1.1 0 1 0 1 P1.0 1 0 1 С³µÔËÐÐ״̬ ǰ½ø ºóÍË ×óתÍä ÓÒתÍä ÎÞÕϰÎï ×ó²à¼ì²âµ½ÕϰÎï ÓÒ²à¼ì²âµ½ÕϰÎï ÓÒ²à¼ì²âµ½ÕϰÎï Ö±×ß ÓÒת ×óת ºóÍË
ͼ2-3 С³µ±ÜÕÏÁ÷³Ìͼ
2.2.5Ö±Á÷µç»úС³µºìÍâÒ£¿Ø¿ØÖÆÔÀí
ÔÚÖ÷¿Ø°åÉϲåÉϺìÍâÒ»Ì廯½ÓÊÕÍ·1838£¬¹æ¶¨Ð¡³µµÄǰ½ø¡¢ºóÍË¡¢×óת¡¢ÓÒת¿ØÖƼü£¬·Ö±ðΪң¿ØÆ÷µÄHT6221°´¼üµÄǰ¡¢ºó¡¢×ó¡¢ÓÒ°´¼ü¡£µ±°´¼ü°´ÏÂÖ®ºó£¬Ò£¿ØÆ÷µÄºìÍâ·¢¹â¶þ¼«¹Ü£¬¾Í»á·¢Éäµ÷ÖÆµÄÖ¸ÁîÐźţ¬ÓëÖ÷¿ØÐ¾Æ¬Á¬½ÓµÄºìÍâÒ»Ìå½ÓÊÕÍ·£¬½ÓÊÕµ½¸ÃÐźźó£¬×ªÎªÏàÓ¦µÄµçÐźţ¬ÔÙËͺóÖ÷ŴóÆ÷£¬µ¥Æ¬»ú¾Í»áÊÕµ½ÖжÏÇëÇó£¬È»ºó½øÐнâÂë¡£½Ó×Å£¬ÀûÓÃswitch-caseÓï¾ä½øÐпØÖÆ£¬´Ó¶øÊ¹Ð¡³µ½øÐв»Í¬µÄÔ˶¯¡£Á÷³ÌͼÈçͼ2-4Ëùʾ¡£
- 15 -
°´×ó¼ü °´ÓÒ¼ü ǰ½ø¼ü ºóÍ˼ü ÔÝÍ£¼ü ×óת ÓÒת ǰ½ø ºóÍË Í£Ö¹
ͼ2-4С³µÒ£¿Ø»ù±¾Á÷³Ìͼ
2.3 Ö±Á÷µç»úС³µ¾ßÌåÍê³ÉÈÎÎñÓë¸Ä½ø
2.3.1Ö±Á÷µç»úС³µµÄÓ²¼þ×é×°ÈÎÎñʵÏÖ ¢Ù°²×°Ð¡³µµ×ÅÌ£¬Òý³öµç»úÏß
¢Ú°²×°²¢¹Ì¶¨ËĸöѰ¼£Ì½Í·£¬°²×°±ÜÕÏ̽ͷ
¢ÛÓÃÍÖù¹Ì¶¨ËÄ·ºìÍâѰ¼£Ä£¿é£¬²¢°ÑÏßÒý³ö£¬¹Ì¶¨ºÃËÄ·ֱÁ÷µç»úÇý¶¯ ¢Ü°ÑÉϲã°åÍùϹ̶¨£¬²¢°ÑÏß´©¹ýµ×°åÓë̽ͷÏàÁ¬£¬È»ºóÁ¬½Óµç»úÏßÁ¬½ÓºÃµÄʵÎïͼÈçͼ2-5Ëùʾ
- 16 -
ͼ2-5 Ö±Á÷µç»úС³µÊµÎïͼ
2.3.2Ö±Á÷µç»úС³µ»ù±¾Ô˶¯ÈÎÎñʵÏÖ ¢ÙÖ±Á÷µç»úС³µ»ù±¾Ô˶¯ÈÎÎñʵÏÖ³ÌÐò£º #include
void delay(unsigned int k) { }
//È«ËÙǰ½ø void run(void) { }
//È«ËÙºóÍË
void backrun(void)
{ } //×óת
void leftrun(void) { } //ÓÒת
void rightrun(void) { } //ͣת
void stoprun(void) {
Left_moto_Stop; Right_moto_Stop; }
/*--Ö÷º¯Êý--*/ void main(void) {
¶¯×´Ì¬
- 17 -
Left_moto_back Right_moto_back
Left_moto_go Left_moto_back Left_moto_Stop Right_moto_go Right_moto_back Right_moto_Stop {P1_0=1,P1_1=0,P1_2=1,P1_3=0;} {P1_0=0,P1_1=0,P1_2=0,P1_3=1;} {P1_0=0,P1_1=0,P1_2=0,P1_3=0;} {P1_4=1,P1_5=0,P1_6=1,P1_7=0;} {P1_4=0,P1_5=1,P1_6=0,P1_7=1;} {P1_4=0,P1_5=0,P1_6=0,P1_7=0;}
Left_moto_back; Right_moto_go;
Left_moto_go; Right_moto_back;
unsigned int x,y; for(x=0;x for(y=0;y<125;y++); delay(100); run(); while(1) { run();//½«run()¸Ä³É Left_moto_go; Right_moto_go; ÆäËûÈýÖÖÔ˶¯×´Ì¬¼´¿ÉʵÏÖÆäËûÈýÖÖÔË