    double calculateSpeedError(double desired_speed, double actual_speed);

    /**
     * @brief Getters and setters for the errors in heading angle of the robot in the robot frame and its linear speed
     * 
     */
    void setHeadingError(double);