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输出低电平
//延迟等待一段时间后,返回零点
}
欢迎光临 电子技术论坛_中国专业的电子工程师学习交流社区-中电网技术论坛 (http://bbs.eccn.com/) | Powered by Discuz! 7.0.0 |