27,22 → 27,23 |
/** |
* test one or more motors |
*/ |
void Handler::motor_test(sMotorData motor) { |
char tx_data[MAX_MOTORS]; |
for (int z = 0; z<MAX_MOTORS; z++) |
void Handler::motor_test(sMotor motor) { |
char tx_data[12]; |
for (int z = 0; z<12; z++) |
{ |
tx_data[z] = motor.desired_speed[z]; |
tx_data[z] = motor.Speed[z]; |
} |
com->send_cmd('t', ADDRESS_FC, tx_data, MAX_MOTORS, false); |
com->send_cmd('t', ADDRESS_FC, tx_data, 12, false); |
} |
|
void Handler::reset_motor() { |
for (int z = 0; z<MAX_MOTORS; z++) |
sMotor motor; |
for (int z = 0; z<12; z++) |
{ |
data->motor.desired_speed[z] = 0; |
motor.Speed[z] = 0; |
} |
|
motor_test(data->motor); |
motor_test(motor); |
} |
|
/** |