【正文】 }}64。 } if(BaQi[0]==0XA5) if(BaQi[1]==0X5A) if(BaQi[2]==0X04) if(BaQi[3]==0XB6) if(BaQi[4]==0XBA) if(BaQi[5]==0XAA) { D=D1。 }/**************************************************************/ if(BaQi[0]==0XA5) if(BaQi[1]==0X5A) if(BaQi[2]==0X04) if(BaQi[3]==0XB5) if(BaQi[4]==0XB9) if(BaQi[5]==0XAA) { D=D+1。 } if(BaQi[0]==0XA5) if(BaQi[1]==0X5A) if(BaQi[2]==0X04) if(BaQi[3]==0XB4) if(BaQi[4]==0XB8) if(BaQi[5]==0XAA) { B=B1。 } /**************************** B *****************************/ if(BaQi[0]==0XA5) if(BaQi[1]==0X5A) if(BaQi[2]==0X04) if(BaQi[3]==0XB3) if(BaQi[4]==0XB7) if(BaQi[5]==0XAA) { B=B+1 。 } if(BaQi[0]==0XA5) if(BaQi[1]==0X5A) if(BaQi[2]==0X04) if(BaQi[3]==0XB2) if(BaQi[4]==0XB6) if(BaQi[5]==0XAA) { A=。 if(BaQi[0]==0XA5) if(BaQi[1]==0X5A) if(BaQi[2]==0X04) if(BaQi[3]==0XB1) if(BaQi[4]==0XB5) if(BaQi[5]==0XAA) { A=A+。 //CcdUart_RecvBlock(BaQi,6,amp。}/************************************藍牙控制**************************************/void ReadUartBlock(void){ word p。 Motor1Speed = 0。}/*************************編碼器數(shù)值換算以及清零************************************/void ShowMotorSpeed(void) //編碼器數(shù)值換算以及清零{ = *Motor1Speed。 [130] = ~2。}/************************串口通訊協(xié)議*********************/void SendPixel1(void){ [0] = 2。 }}/*********************程序總中斷*************************/void CcdExposureTimeCalculation(void) { TimerCnt10ms++。 //Stopcar_Disable()。 LED3_PutVal(1)。 LED1_PutVal(1)。 beep_PutVal(1)。 SendPixel1()。 LcdInitialize()。}/************************程序匯合傳送門****************/void TheMainFunctionToRun(void){ CcdSamplingFunction()。//輸出限幅 if(=5)=5。 //記錄上上次偏差 Historyerror2_1=。 } else { =254。 //上上次偏差 = Speed 。}unsigned char PidRealize_M2(unsigned char Speed){ signed int static Historyerror2_1。//輸出限幅 if(=5)=5。 //記錄上上次偏差 Historyerror1_1=。 } else { =254。 //上上次偏差 = Speed 。 }}/************************ 電機PID控制***************************************/unsigned char PidRealize_M1(unsigned char Speed){ signed int static Historyerror1_1。 Motor1_SetRatio8(255PidRealize_M1())。 } else //正常行車 { Motor1_1_PutVal(1)。 Motor1_SetRatio8(20)。 } else if(slowflag==3)//左 { Motor1_1_PutVal(0)。 Motor1_SetRatio8(80)。 } else if(slowflag==2)//右 { Motor1_1_PutVal(0)。 Motor2_SetRatio8(250)。 Motor2_SetRatio8(250)。 Motor2_1_PutVal(1)。 } } if(slowflag==1 || stopflag=2)//減速 { x++。 if(highspeed) { =highspeed。 } } else { = needforspeedPc*(unsigned char)(abs( )/Pj)。 if(highspeed) { =highspeed。 if() { = needforspeed+Pc*(unsigned char)(abs( )/Pj)。XShi)。i++) { [i+2] = [i]。 for(i=0。 //設(shè)置參數(shù) /********************發(fā)送數(shù)據(jù)至上位機***************/ /*j++。 //二值化 電機控速度 MotorSpeedcontrol()。//二值化amp。 //CCD1采集 //ImageCapture1()。 ShowMotorSpeed()。 unsigned char XShi。}/***********************主控函數(shù)*******************************/void CcdSamplingFunction(void){ unsigned char *Null。 } else flagleft=0。 break。i) //左邊黑線掃描 { if(CompareA[i]220) { flagleft++。 for(i=127。 }}/********************MAIN電機控制算法 變量：灰度數(shù)組1***********************/void BlackCaptureCar(unsigned char *CompareA){ unsigned char flagleft=0。 } else { //beep_PutVal(1)。amp。 else slowflag=3。 //beep_PutVal(0)。amp。amp。 //LcdWriteNum1(1,50,)。 //LcdWriteNum(1,20,)。 } = 。 }else if(=(+1200)) { Steering_SetRatio16(+1200)。 //KD靜態(tài) = +*+ \ *( )。/**************************舵機控制******************************/ = B+A**。 } /********************************************************/ } flagleft=0。 //中線偏差計算 } } else { =。 //中線偏差計算 } else { if(blockflag) =*()。 if(60) { if(blockflag) =*()。 blockdelayflag=15。 } else { blockflag=0。 abs([3])5) blockflag=1。 74 amp。 50 amp。 else if(60 amp。amp。amp。amp。amp。 /*************************障礙識別******************************/ Distance=。 HistoryDataR[1]=HistoryDataR[0]。 HistoryDataR[3]=HistoryDataR[2]。 HistoryDataR[5]=HistoryDataR[4]。 HistoryDataR[7]=HistoryDataR[6]。 HistoryDataR[9]=HistoryDataR[8]。 HistoryDataL[1]=HistoryDataL[0]。 HistoryDataL[3]=HistoryDataL[2]。 HistoryDataL[5]=HistoryDataL[4]。 HistoryDataL[7]=HistoryDataL[6]。 //記錄歷史數(shù)組 HistoryDataL[9]=HistoryDataL[8]。 HistoryData[1]=HistoryData[0]。 HistoryData[3]=HistoryData[2]。 HistoryData[5]=HistoryData[4]。 HistoryData[7]=HistoryData[6]。 //中線偏差計算 HistoryData[9]=HistoryData[8]。 //重置左邊掃描位置初值 CoordinateRight = (+)/2。 //線性補線 }/******************************正常處理*********************************/ else { =(+)/2。 if(100) { =+25。 //重置左邊掃描位置初值 CoordinateRight = 55。 //重置左邊掃描位置初值 CoordinateRight = 65。 CoordinateRight = 61。amp。 = ()*。 lostright) //全部