Subversion Repositories Projects

Compare Revisions

Ignore whitespace Rev 441 → Rev 442

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