我这只有舵机,摄像头,与主程序,但是只是框架,要等调试.docVIP

我这只有舵机，摄像头，和主程序，但是只是框架，要等调试。可以参考哈 #ifndef _WATCH_H_ //头文件保护 #define _WATCH_H_ #ifndef ULONG #define ULONG unsigned long #define UCHAR unsigned char #define UINT unsigned int #endif #define ROAD_MAX 10 ////////////////代设值 #define MP0 //捕捉象素引脚 #define HREF //捕捉行中断引脚 ////////////////// static unsigned char Colors[10][48]; //象素数组 static unsigned char JudgeMax; //最大象素 static unsigned char JudgeMin; //最小象素 unsigned char Over; //中断函数处理完成 //使用数组后要清零 struct ROADS { unsigned char LeftRight; //1 left, 0 right 2 表示没检测到黑线 4表示起始线 unsigned int road; //转向率，0表示直线或则没检测到黑线 }Roads[10]; //没检测到黑线一般为前方有大于90度的弯， //行驶一会后数组会更新，不会因此丢掉跑道 unsigned long RoadLength； //mm单位 void GetRoads(); //取象素 void ProcessRoads(); //取转向率 void delay(UINT); //延时函数 void ColorToRoads(UINT); //2值化与赋值 #endif //_WATCH_H_ 以下为实现文件： //watch.c #include hidef.h /* common defines and macros */ #include MC9S12XS128.h /* derivative information */ #include watch.h #pragma CODE_SEG NON_BANKED #pragma TRAP_PROC void GetRoads() //场中断服务函数 { UINT i; UINT Href= 0; delay(5); while(HREF) { if(Href= 270) //点读取完毕，退出循环 break; if((270-Href)%21!= 0 || Href 60) //取60-270行中平均间隔的行数，共30行 { Href++; while(HREF); //等待此行扫描结束 while(!HREF); //等待新行开始扫描 continue; } delay(...); //根据调式结果具体设置 for(i= 0; i 48; i++) { Colors[((270-Href)%21)][i]= MP0; //读取引脚数据，后来会根据串口还是并口读取做相应修改 if(MP0 judgeMax) //取最大最小值 JudgeMax= MP0; if(MP0 JudgeMin) JudgeMin= MP0; delay(...); //具体设置 } Href++; while(HREF); while(!HREF); //等待行中断结束 } Over= 1; //中断函数处理完成 } #pragma CODE_SEG DEFAULT void ColorToRoads(UINT Href) { UINT i; UINT temp; //用于起始线判断 UINT temp2; UINT temp3; UCHAR Judge; //平均厥值 UINT j= 0; UINT m_nCount= 0; Judge= (JudgeMax+ JydgeMin)/2; Roads[Href].road= 0; Roads[Href].LeftRight= 0; for(i= 0; i48; i+= 3) { if(Colors[i]= Judge|| Colors[i+ 1]= Judge|| Colors[i+ 2]= Judge) { Roads[Href].road= (0x8000 (UCHAR)j); //相应位赋值为1 m_nCount++; } j++; } if(Roads[Href].road== 0x00) { Ro