電賽小白新手跪求尋跡開源代碼

ID:1087975 · 發(fā)表于 2023-7-10 15:59

跪求基于MSP430F5529單片機的循跡小車的尋跡完整開源程序代碼，在線急急急！
拜三拜，謝求大佬！

ID:388929 · 發(fā)表于 2023-7-11 12:20

一直跪著吧，不用起來了

ID:1088156 · 發(fā)表于 2023-7-12 00:53

可以按這個來，供參考，且末尾也注明出處了。
#include "msp430f5529.h"

void qj() //前進

{

   P3OUT &=~ BIT0;

   P3OUT |=BIT1;

   P2OUT &=~ BIT0;

   P2OUT |=BIT2;

}

void tz() //停止

{

   P3OUT &=~ BIT0;

   P3OUT &=~ BIT1;

   P2OUT &=~ BIT0;

   P2OUT &=~ BIT2;

}

void zz() //左轉(zhuǎn)

{

   P3OUT |=BIT0;

   P3OUT &=~ BIT1;

   P2OUT &=~ BIT0;

   P2OUT |= BIT2;

}

void yz() //右轉(zhuǎn)

{

   P3OUT &=~ BIT0;

   P3OUT |= BIT1;

   P2OUT |= BIT0;

   P2OUT &=~ BIT2;

}

void main()

{

WDTCTL = WDTPW | WDTHOLD; //關(guān)閉看門狗

P4DIR |=BIT1; //輸出給ENA(左輪)

P4DIR |=BIT2; //輸出給ENB(右輪)

P3DIR |=BIT0; //輸出給IN1(左輪)

P3DIR |=BIT1; //輸出給IN2

P2DIR |=BIT0; //輸出給IN3(右輪)

P2DIR |=BIT2; //輸出給IN4

P6DIR |=BIT0; //輸出給蜂鳴器

P1DIR &=~ BIT2;  //左紅外輸入

P4DIR &=~ BIT3;  //右紅外輸入

P1REN |= BIT2; //為輸入設置上拉電阻

P4REN |= BIT3;

P4OUT &=~ BIT1;  //將輸入輸出口置零

P4OUT &=~ BIT2;

P3OUT &=~ BIT0;

P3OUT &=~ BIT1;

P2OUT &=~ BIT0;

P2OUT &=~ BIT2;

P6OUT &=~ BIT0;

P1OUT &=~ BIT2;

P4OUT &=~ BIT3;

while(1)

{

   if(P1IN&BIT2) //P1.2為1時執(zhí)行

   {

      if(P4IN&BIT3) //P4.3為1時執(zhí)行

      {

         tz();    //調(diào)用“停止”指令

      }

      else       //P4.3為0時執(zhí)行

      {

         zz();

      }

   }

   else       //P1.2為0時執(zhí)行

   {

      if(P4IN&BIT3) //P4.3為1時執(zhí)行

      {

         yz();

      }

      else       //P4.3為0時執(zhí)行

      {

         qj();

      }

   }

}

}
————————————————
版權(quán)聲明：本文為CSDN博主「蕭勍」的原創(chuàng)文章，遵循CC 4.0 BY-SA版權(quán)協(xié)議，轉(zhuǎn)載請附上原文出處鏈接及本聲明。
原文鏈接：https://blog.csdn.net/kalixiaou/article/details/121144516

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

電賽小白新手跪求尋跡開源代碼