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; } }