chnage DATA_MOTOR_TACHO to DATA_MOTOR_STATUS in lejos firmware