Relative move (#71)

---------

Co-authored-by: github-actions <41898282+github-actions[bot]@users.noreply.github.com>

include/VOSS/chassis/AbstractChassis.hpp

@@ -39,6 +39,15 @@ class AbstractChassis {
     virtual bool execute(DiffChassisCommand cmd, double max) = 0;
     virtual void set_brake_mode(pros::motor_brake_mode_e mode) = 0;
 
+    void move(double distance, double max = 100.0,
+              voss::Flags flags = voss::Flags::NONE);
+
+    void move(double distance, controller_ptr controller, double max = 100.0,
+              voss::Flags flags = voss::Flags::NONE);
+
+    void move(double distance, controller_ptr controller, ec_ptr ec,
+              double max = 100.0, voss::Flags flags = voss::Flags::NONE);
+
     void move(Pose target, controller_ptr controller, ec_ptr ec,
               double max = 100.0, voss::Flags flags = voss::Flags::NONE);
 

include/VOSS/utils/flags.hpp

@@ -22,5 +22,11 @@ auto inline operator&(Flags flag1, Flags flag2) {
                              static_cast<uint8_t>(flag2));
 }
 
-enum class AngularDirection { AUTO, COUNTERCLOCKWISE, CLOCKWISE };
+enum class AngularDirection {
+    AUTO,
+    COUNTERCLOCKWISE,
+    CCW = COUNTERCLOCKWISE,
+    CLOCKWISE,
+    CW = CLOCKWISE
+};
 } // namespace voss

src/VOSS/chassis/AbstractChassis.cpp

@@ -70,6 +70,23 @@ void AbstractChassis::turn_task(controller_ptr controller, ec_ptr ec,
     this->task->join();
 }
 
+void AbstractChassis::move(double distance, double max, voss::Flags flags) {
+    this->move({distance, 0}, this->default_controller, this->default_ec, max,
+               flags | voss::Flags::RELATIVE);
+}
+
+void AbstractChassis::move(double distance, controller_ptr controller,
+                           double max, voss::Flags flags) {
+    this->move({distance, 0}, std::move(controller), this->default_ec, max,
+               flags | voss::Flags::RELATIVE);
+}
+
+void AbstractChassis::move(double distance, controller_ptr controller,
+                           ec_ptr ec, double max, voss::Flags flags) {
+    this->move({distance, 0}, std::move(controller), std::move(ec), max,
+               flags | Flags::RELATIVE);
+}
+
 void AbstractChassis::move(Pose target, double max, voss::Flags flags) {
     this->move(target, this->default_controller, this->default_ec, max, flags);
 }

src/VOSS/chassis/DiffChassis.cpp

@@ -35,6 +35,8 @@ DiffChassis::DiffChassis(std::initializer_list<int8_t> left_motors,
 
     this->slew_step = slew_step > 0 ? slew_step : 200;
     this->brakeMode = brakeMode;
+    this->left_motors->set_brake_mode(this->brakeMode);
+    this->right_motors->set_brake_mode(this->brakeMode);
     this->prev_voltages = {0, 0};
 }
 

src/VOSS/controller/BoomerangController.cpp

@@ -60,6 +60,7 @@ BoomerangController::get_command(bool reverse, bool thru,
         } else {
             // turn to face the finale pose angle if executing a pose movement
             double poseError = target.theta.value() - current_angle;
+
             while (fabs(poseError) > M_PI)
                 poseError -= 2 * M_PI * poseError / fabs(poseError);
             ang_speed = angular_pid(poseError);

src/VOSS/controller/PIDController.cpp

@@ -55,6 +55,7 @@ PIDController::get_command(bool reverse, bool thru,
         } else {
             // turn to face the finale pose angle if executing a pose movement
             double poseError = target.theta.value() - current_angle;
+
             while (fabs(poseError) > M_PI)
                 poseError -= 2 * M_PI * poseError / fabs(poseError);
             ang_speed = angular_pid(poseError);

src/VOSS/localizer/AbstractLocalizer.cpp

@@ -46,7 +46,6 @@ Pose AbstractLocalizer::get_pose() {
     std::unique_lock<pros::Mutex> lock(this->mtx);
     Pose ret = {this->pose.x.load(), this->pose.y.load(),
                 this->pose.theta.load()};
-
     return ret;
 }