3舞蹈机器人程序y,广州吊床垫

{ int k ; while(ms--) { for(k=12500; k>0 ; k--) _nop_() ; _nop_() ; _nop_() ; _nop_() ; }}/********************************************************//* 开关电机 *//* 0--关电机 //关某位用 1 或，其他位为0 *//* 1--正转 //开某位用 0 与，其他位为1 *//* 2--反转 *//********************************************************/void moto0(unsigned char s0){ switch(s0) { case 0: temp_0=temp; temp_0 break ; //关电机 case 1: temp_0=temp; temp_0&=0xfffe; temp=temp_0; break ; //正转 case 2: temp_0=temp; temp_0&=0xfffd; temp=temp_0; break ; //反转 }}void moto1(unsigned char s1){ switch(s1) { case 0: temp_1=temp; temp_1 break ; //关电机 case 1: temp_1=temp; temp_1&=0xfffb; temp=temp_1; break ; //正转 case 2: temp_1=temp; temp_1&=0xfff7; temp=temp_1; break ; //反转 }} void moto2(unsigned char s2){ switch(s2) { case 0: temp_2=temp; temp_2 break ; //关电机 case 1: temp_2=temp; temp_2&=0xffef; temp=temp_2; break ; //正转 case 2: temp_2=temp; temp_2&=0xffdf; temp=temp_2; break ; //反转 }}void moto3(unsigned char s3){ switch(s3) { case 0: temp_3=temp; temp_3 break ; //关电机 case 1: temp_3=temp; temp_3&=0xffbf; temp=temp_3; break ; //正转 case 2: temp_3=temp; temp_3&=0xff7f; temp=temp_3; break ; //反转 }}void moto4(unsigned char s4){ switch(s4) { case 0: =0x0300; temp=temp_4; break ; //关电机 case 1: temp_4=temp; temp_4&=0xfeff; temp=temp_4; break ; //正转 case 2: temp_4=temp; temp_4&=0xfdff; temp=temp_4; break ; //反转 }}void moto5(unsigned char s5){ switch(s5) { case 0: =0x0c00; temp=temp_5; break ; //关电机 case 1: temp_5=temp; temp_5&=0xfbff; temp=temp_5; break ; //正转 case 2: temp_5=temp; temp_5&=0xf7ff; temp=temp_5; break ; //反转 }}void moto6(unsigned char s6){ switch(s6) { case 0: temp_6=temp; temp_6 break ; //关电机 case 1: temp_6=temp; temp_6&=0xefff; temp=temp_6; break ; //正转 case 2: temp_6=temp; temp_6&=0xdfff; temp=temp_6; break ; //反转 }}void moto7(unsigned char s7){ switch(s7) { case 0: temp_7=temp; temp_7 break ; //