void motorMove (int xd,int yd,int zd){
//sFlag='F';//标志位恢复到'F' //M1电机运动到xd PORTA_BIT0=0xFF;//PA0输出高电平(正转),即用PA0控制电机方向 for (j=0;j<=xd;j++){ PTP_PTP5=0xff;// PP5输出高电平 delay1s(); PTP_PTP5=0x00;//PP5输出低电平 delay1s(); } PTP_PTP5=0x00;//M1停止后,PP5输出低电平 //M2电机运动到iY1 PORTA_BIT2=0xff;//PA2输出高电平(正转),即用PA2控制电机方向 for (j=0;j<=yd;j++){ PTP_PTP4=0xff;// PP4输出高电平 delay1s(); PTP_PTP4=0x00;//PP4输出低电平 delay1s(); } PTP_PTP4=0x00;//M2停止后,PP4输出低电平 //M3电机运动到iZ PORTA_BIT4=0xff;//PA4输出高电平(正转),即用PA4控制电机方向 for (j=0;j<=zd;j++){ PTP_PTP3=0xff;// PP3输出高电平 delay1s(); PTP_PTP3=0x00;//PP3输出低电平 delay1s(); } PTP_PTP3=0x00;//M3停止后,PP3输出低电平
//延迟等待一段时间后,返回零点
}
|