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)); }