5路循跡模塊最近自己弄出來的程序，PID算法C代碼等資料 跟大家分享一下.
普通尋跡單片機源代碼：
- /*NewWay 循跡模塊專用程序*/
- /*簡單循跡程序，此程序能讓小車沿著黑線移動*/
- /*你可以任意使用、修改該程序，如果你要把該程序用于商業，請與我聯系，不然一切后果自己承擔*/
- /*當你看到這個程序的時候，請注意，這個程序是不能直接使用的，你要自己實現小車的向前，向后，向左，向右,及其延時的子程序*/
- #include <REGX52.H>
- void CarGo();
- void CarBack();
- void CarTurnLeft();
- void CarTurnRight();
- void Delayms();
- void CarStop();
- /*定義循跡傳感器管腳*/
- sbit CLP=P1^0;
- sbit SS1=P1^1;
- sbit SS2=P1^2;
- sbit SS3=P1^3;
- sbit SS4=P1^4;
- sbit SS5=P1^5;
- sbit Near=P1^6;
- void main(void)
- {
- CarGo();
- while(1)
- {
- if(SS2==0)
- {
- CarTurnLeft();
- }
- else
- {
- if(SS4==0)
- {
- CarTurnRight();
- }
- else
- {
- CarGo();
- }
- }
- }
- }
下載：
5路循跡模塊資料.rar
(1.14 MB, 下載次數: 634)
2017-4-3 20:19 上傳
點擊文件名下載附件
|
[復制鏈接]
