四爪追光机器人代码.docx

附录：LED闪烁灯实物图小LED显示屏实物图小LED显示屏程序Const row5=2,7,5,13,18Const int col5=6,11,10,3,4;Int pixels55;Int x=5;Int y=5;Void setup ()For (int thisPin=0;thisPin5;thisPin+)pinMode(colthisPin,OUTPUT);pinMode(rowthisPin,OUTPUT);digitalWrite(colthisPin,HIGH);For(int x=0;x5;x+)For(int y=0;y5;y+)Pixelsxy=HIGH;Void loop()readSensors();refreshScreen();Void readSensors()Pixelsxy=HIGH;X=7-map(analogRead(A0),0,1023,0,7);Y=map(analogRead(A1),0,1023,0,7);Pixelsxy=LOW;Void refreshScreen()For(int thisRow=0;thisRow5;thisRow+)digitalWrite(rowthisRow,HIGH);for(int thisCol=0;thisCol50) MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,700,512); MFSetServoPos(4,300,512); MFSetServoPos(9,400,512); MFSetServoPos(1,400,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,400,512); MFSetServoPos(4,400,512); MFSetServoPos(9,400,512); MFSetServoPos(1,400,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,700,512); MFSetServoPos(4,300,512); MFSetServoPos(9,400,512); MFSetServoPos(1,400,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,300,512); MFSetServoPos(6,400,512); MFSetServoPos(10,650,512); MFSetServoPos(4,300,512); MFSetServoPos(9,400,512); MFSetServoPos(1,400,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,650,512); MFSetServoPos(4,300,512); MFSetServoPos(9,512,512); MFSetServoPos(1,512,512); MFServoAction(); /If Left is less than Right if (Diff=-50)&(Diff=50) MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,700,512); MFSetServoPos(4,300,512); MFSetServoPos(9,512,512); MFSetServoPos(1,512,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,600,512); MFSetServoPos(8,400,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,700,512); MFSetServoPos(4,300,512); MFSetServoPos(9,512,512); MFSetServoPos(1,512,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,600,512); MFSetServoPos(3,400,512); MFSetServoPos(5,700,512); MFSetServoPos(6,300,512); MFSetServoPos(10,700,512); MFSetServoPos(4,300,512); MFSetServoPos(9,512,512); MFSetServoPos(1,512,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,400,512); MFSetServoPos(6,400,512); MFSetServoPos(10,650,512); MFSetServoPos(4,300,512); MFSetServoPos(9,512,512); MFSetServoPos(1,512,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServoPos(6,300,512); MFSetServoPos(10,400,512); MFSetServoPos(4,400,512); MFSetServoPos(9,512,512); MFSetServoPos(1,512,512); MFServoAction(); DelayMS(1000); MFSetServoPos(2,300,512); MFSetServoPos(8,300,512); MFSetServoPos(7,400,512); MFSetServoPos(3,300,512); MFSetServoPos(5,600,512); MFSetServ