Subversion Repositories Projects

Compare Revisions

Ignore whitespace Rev 442 → Rev 441

/QMK-Groundstation/branches/libMK/libMK/Handler.cpp
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);
}
 
/**