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

关电机 case 1: temp_7=temp; temp_7&=0xbfff; temp=temp_7; break ; //正转 case 2: temp_7=temp; temp_7&=0x7fff; temp=temp_7; break ; //反转 }}/********************************************************//* 脉冲电机控制 *//* num_i--输入电机的转动角数 *//* state0_B--前一个电平状态 *//* state0_A--当前电平状态 *//********************************************************/void scan0(unsigned int n0)num_0=n0; void scan1(unsigned int n1)num_1=n1; void scan2(unsigned int n2)num_2=n2;void scan3(unsigned int n3) num_3=n3; void scan4(unsigned int n4)num_4=n4; void scan5(unsigned int n5)num_5=n5; void scan6(unsigned int n6)num_6=n6; /* void scan7(unsigned int n7)num_7=n7;void scan8(unsigned int n5)num_5=n5; */void scan(void){/***************** 第 0 个扫描 ***************************************/ state0_B=state0_A; _nop_() ; state0_A=in0; if(state0_A!=state0_B) //判断是否有电平跳变 { count_0++; if(count_0>num_0) moto0(0); start_595(); count_0=0; num--; num_0=0xffff; }/****************** 第一个扫描 *************************************/ state1_B=state1_A; _nop_() ; state1_A=in1; if(state1_A!=state1_B) //判断是否有电平跳变 { count_1++; if(count_1>num_1) moto1(0); start_595(); count_1=0; num--; num_1=0xffff; }/***************** 第二个扫描 ***************************************/ state2_B=state2_A; _nop_() ; state2_A=in2; if(state2_A!=state2_B) //判断是否有电平跳变 { count_2++; if(count_2>num_2) moto2(0); start_595(); count_2=0; num--; num_2=0xffff; }/***************** 第三个扫描 **************************************/ state3_B=state3_A; _nop_() ; state3_A=in3; if(state3_A!=state3_B) //判断是否有电平跳变 { count_3++; if(count_3>num_3) moto3(0); start_595(); count_3=0; num--; num_3=0xffff; }/**************** 第四个扫描 *************************************/ state4_B=state4_A; _nop_() ; state4_A=in4; if(state4_A!=state4_B) //判断是否有电平跳变 { count_4++; if(count_4>num_4) moto4(0); start_595(); count_4=0; num--; num_4=0xffff; }/**************** 第五个扫描 ************