Beispiel #1
0
void MotorControl::move(float power, float move_angle) {
    power_ = power;
    move_angle_ = move_angle;

    double cosine = acceleration_rate_ * power * cos(move_angle * 0.0174533);
    double sine   = acceleration_rate_ * power * sin(move_angle * 0.0174533);

    motor1->run(omega + ( 0.35 * sine - 0.6062177826491071 * cosine));
    motor2->run(omega + (-0.70 * sine));
    motor3->run(omega + ( 0.35 * sine + 0.6062177826491071 * cosine));
}