武术机器人源代码.doc_第1页
武术机器人源代码.doc_第2页
武术机器人源代码.doc_第3页
武术机器人源代码.doc_第4页
武术机器人源代码.doc_第5页
已阅读5页，还剩6页未读， 继续免费阅读

下载本文档

版权说明：本文档由用户提供并上传，收益归属内容提供方，若内容存在侵权，请进行举报或认领

文档简介

#include Apps/SystemTask.h #include funcwalk.huint8 SERVO_MAPPING5 = 1,2,3,4,5;int main() int x = 0; int nchess = 0; int y = 0; int enemy = 0; int bian = 0; int ad4 = 0; int test = 0; int io10 = 0; int nbian = 0; int chess = 0; MFInit(); MFInitServoMapping(&SERVO_MAPPING0,5); MFSetPortDirect(0x00000C00); MFSetServoMode(1,1); MFSetServoMode(2,1); MFSetServoMode(3,1); MFSetServoMode(4,1); MFSetServoMode(5,0); DelayMS(1000); while (1) io8 = MFGetDigiInput(8); io9 = MFGetDigiInput(9); if (io8=0)|(io9=0) break ; DelayMS(100); MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,80); MFServoAction(); DelayMS(7000); for (x=0;x=1) break; while (1) io0 = MFGetDigiInput(0); io1 = MFGetDigiInput(1); io2 = MFGetDigiInput(2); io3 = MFGetDigiInput(3); io4 = MFGetDigiInput(4); io6 = MFGetDigiInput(6); io7 = MFGetDigiInput(7); io8 = MFGetDigiInput(8); io9 = MFGetDigiInput(9); ad0 = MFGetAD(0); ad1 = MFGetAD(1); ad2 = MFGetAD(2); ad3 = MFGetAD(3); nbian=io0+io1+io2+io3; nchess=io6*io7*io8*io9; /nbian=1,检测到边沿 /nchess=0,检测到物体 if (nbian0) /testbian int testbian() /0 未到边沿 /1 前方到达边沿 /2 左方到达边沿 /3 右方到达边沿 /4 后方到达边沿 io0 = MFGetDigiInput(0); io1= MFGetDigiInput(1); io2= MFGetDigiInput(2); io3= MFGetDigiInput(3); if(io0=1|io1=1) return 1; else if(io2=1) return 2; else if(io3=1) return 3; /else if(io4=1) / /return 4; / else return 0; return 0; bian=testbian(); switch (bian) case 1: for (y=0;y200|ad1200|nbian=1) break; for (x=0;x=1|nchess=0|ad0200|ad1200) break ; MFSetServoRotaSpd(1,1023); MFSetServoRotaSpd(2,1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(7); break ; case 4: MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(1000); break ; default : break ; switch (bian) case 2: MFSetServoRotaSpd(1,1023); MFSetServoRotaSpd(2,1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(1000); for (x=0;x=1) break ; MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(10); break ; case 3: MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,-1023); MFSetServoRotaSpd(4,-1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(1000); for (x=0;x=1) break ; MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(10); break ; case 0: MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(100); break ; else if (ad0200)|(ad1200)|(ad270)|(ad370) /testenemy int testenemy() /0 未检测到敌人 /1 前方检测到敌人 /2 左方检测到敌人 /3 右方检测到敌人 /4 后方检测到敌人 ad0 = MFGetAD(0); ad1 = MFGetAD(1); ad2 = MFGetAD(2); ad3 = MFGetAD(3); if(ad0200|ad1200) return 1; else if(ad270) return 2; else if(ad370) return 3; /else if(ad40) / /return 4; / else return 0; return 0; enemy=testenemy(); switch (enemy) case 1: while (1) MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(100); io2= MFGetDigiInput(2); io3= MFGetDigiInput(3); nbian=io2+io3; ad0 = MFGetAD(0); ad1 = MFGetAD(1); if(nbian=1|ad0200|ad1200) break ; break ; case 2: for (x=0;x200)|(ad1200) break ; MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(100); break ; case 3: for (x=0;x200)|(ad1200) break ; MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(100); break ; else if (nchess=0) /testchess int testchess() /0 未检测到棋子 /1 前方检测到棋子 /2 左方检测到棋子 /3 右方检测到棋子 /4 后方检测到棋子 io6= MFGetDigiInput(6); io7= MFGetDigiInput(7); io8= MFGetDigiInput(8); io9= MFGetDigiInput(9); if(io6=0|io7=0) return 1; else if(io8=0) return 2; else if(io9=0) return 3; /else if(io10=0) / /return 4; / else return 0; return 0; chess=testchess(); switch (chess) case 1: MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(100); break ; case 4: MFSetServoRotaSpd(1,0); MFSetServoRotaSpd(2,0); MFSetServoRotaSpd(3,0); MFSetServoRotaSpd(4,0); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(1000); break ; default : break ; switch (chess) case 2: for (x=0;x150;x+) MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,-1023); MFSetServoRotaSpd(4,-1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(10); io6 = MFGetDigiInput(6); io7 = MFGetDigiInput(7); if (!(io6=1)&(io7=1) break ; MFSetServoRotaSpd(1,-1023); MFSetServoRotaSpd(2,-1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction(); DelayMS(100); break ; case 3: for (x=0;x150;x+) MFSetServoRotaSpd(1,1023); MFSetServoRotaSpd(2,1023); MFSetServoRotaSpd(3,1023); MFSetServoRotaSpd(4,1023); MFSetServoPos(5,180,512); MFServoAction();
人人文库> 全部分类> 应用文书 > 技术指导

温馨提示

  • 1. 本站所有资源如无特殊说明，都需要本地电脑安装OFFICE2007和PDF阅读器。图纸软件为CAD,CAXA,PROE,UG,SolidWorks等.压缩文件请下载最新的WinRAR软件解压。
  • 2. 本站的文档不包含任何第三方提供的附件图纸等，如果需要附件，请联系上传者。文件的所有权益归上传用户所有。
  • 3. 本站RAR压缩包中若带图纸，网页内容里面会有图纸预览，若没有图纸预览就没有图纸。
  • 4. 未经权益所有人同意不得将文件中的内容挪作商业或盈利用途。
  • 5. 人人文库网仅提供信息存储空间，仅对用户上传内容的表现方式做保护处理，对用户上传分享的文档内容本身不做任何修改或编辑，并不能对任何下载内容负责。
  • 6. 下载文件中如有侵权或不适当内容，请与我们联系，我们立即纠正。
  • 7. 本站不保证下载资源的准确性、安全性和完整性, 同时也不承担用户因使用这些下载资源对自己和他人造成任何形式的伤害或损失。

最新文档

评论

0/150

提交评论