RosRobotDriverHandler.hpp

#ifndef KINEMATICS_ROSROBOTDRIVERHANDLER_HPP
#define KINEMATICS_ROSROBOTDRIVERHANDLER_HPP

#include <ros/ros.h>
#include "RobotDriverHandler.hpp"
#include <Kinematics/Matrix.hpp>

namespace HLR
{
namespace Kinematics
{
class RosRobotDriverHandler : public RobotDriverHandler
{
public:
    RosRobotDriverHandler();

    virtual ~RosRobotDriverHandler() = default;

    RosRobotDriverHandler(const RosRobotDriverHandler& rdh) = delete;

    RosRobotDriverHandler(RosRobotDriverHandler&& rdh) = delete;

    RosRobotDriverHandler& operator=(const RosRobotDriverHandler& rdh) = delete;

    RosRobotDriverHandler& operator=(RosRobotDriverHandler&& rdh) = delete;

    Matrix<double, 5, 1> get_arm_state() const noexcept override;

    void move(const std::vector<Matrix<double, 5, 1>>& path,
              double speed) override;

    void stop() override;

private:
    ros::NodeHandle nh;

    ros::ServiceClient driver_stop;

    ros::ServiceClient driver_add;

    Matrix<double, 5, 1> current_arm_state;
};

} // namespace Kinematics
} // namespace HLR

#endif