void action(canMsg msg)
{
unsigned char command = msg.data[0];
unsigned char side, state;
switch(command)
{
case 'A':
side = msg.data[1];
state = msg.data[2];
knockDownTheClapperboards(side, state);
break;
case 'B':
side = msg.data[1];
state = msg.data[2];
colectThePopcorn(side, state);
break;
case 'C':
state = msg.data[1];
leftDiafram(state);
break;
case 'D':
state = msg.data[1];
rightDiafram(state);
break;
case 'E':
state = msg.data[1];
liftStates(state);
break;
}
}
void action(canMsg msg)
{
unsigned char command = msg.data[0];
unsigned char state, direction;
unsigned int angle, speed;
angle = 0;
speed = 0;
switch(command)
{
case 'A':
angle = msg.data[1] << 8 | msg.data[2];
speed = msg.data[3] << 8 | msg.data[4];
direction = msg.data[5];
AX_SetAngle(angle,speed,direction,AX_SERVO1);
break;
case 'B':
angle = msg.data[1] << 8 | msg.data[2];
speed = msg.data[3] << 8 | msg.data[4];
direction = msg.data[5];
AX_SetAngle(angle,speed,direction,AX_SERVO2);
break;
case 'C':
state = msg.data[1];
leftDiafram(state);
break;
case 'D':
state = msg.data[1];
rightDiafram(state);
break;
case 'E':
state = msg.data[1];
liftStates(state);
break;
}
}
