Page 515 - 2
P. 515
0x00; break;
case 2 : motor2(); motor_xy(); motor_x(); delay_ms(500); motor_rxy(); motor_rx(); step =
0x00; break;
case 3 : motor3(); motor_xy(); motor_x(); delay_ms(500); motor_rxy(); motor_rx(); step =
0x00; break;
case 4 : motor4(); motor_xy(); motor_y(); delay_ms(500); motor_rxy(); motor_ry(); step =
0x00; break;
case 5 : motor5(); motor_xy(); motor_x(); delay_ms(500); motor_rxy(); motor_rx(); step =
0x00; break;
case 6 : motor6(); motor_xy(); motor_x(); delay_ms(500); motor_rxy(); motor_rx(); step =
0x00; break;
case 7 : motor7(); motor_xy(); motor_y(); delay_ms(500); motor_rxy(); motor_ry(); step =
0x00; break;
case 8 : motor8(); motor_xy(); motor_x(); motor_y(); delay_ms(500); motor_rxy(); motor_r
x(); motor_ry(); step = 0x00; break;
case 9 : motor9(); motor_xy(); motor_x(); delay_ms(500); motor_rxy(); motor_rx(); step =
0x00; break;
case 10 : motor10(); motor_xy(); motor_y(); delay_ms(500); motor_rxy(); motor_ry(); step
= 0x00; break;
case 11 : motor11(); motor_xy(); motor_y(); motor_x(); delay_ms(500); motor_rxy(); moto
r_rx(); motor_ry(); step = 0x00; break;
case 12 : motor12(); motor_xy(); motor_y(); motor_x(); delay_ms(500); motor_rxy(); moto
r_rx(); motor_ry(); step = 0x00; break;
}
}
void motor_xy() //x 축 y 축 동시 이동
{
for(j=0;j<motor_data_xy[state_all];j++) //x 축 y 축 같이 가기
{
for(i=0;i<4;i++)
{
step = cw[i]|cw2[i];
delay_ms(2);
}
}
}
void motor_rxy() //x 축 y 축 동시 되돌아오기
{
for(j=0;j<motor_data_xy[state_all];j++) //x 축 y 축 같이 되돌아오기
{
for(i=0;i<4;i++)
{
step = ccw[i]|ccw2[i];
- 515 -