mirror of
https://gitlab.com/obbart/universal_robots_ros_driver.git
synced 2026-04-10 10:00:48 +02:00
83 lines
2.4 KiB
C++
83 lines
2.4 KiB
C++
/*
|
|
* ur_driver
|
|
*
|
|
* ----------------------------------------------------------------------------
|
|
* "THE BEER-WARE LICENSE" (Revision 42):
|
|
* <thomas.timm.dk@gmail.com> wrote this file. As long as you retain this notice you
|
|
* can do whatever you want with this stuff. If we meet some day, and you think
|
|
* this stuff is worth it, you can buy me a beer in return. Thomas Timm Andersen
|
|
* ----------------------------------------------------------------------------
|
|
*/
|
|
|
|
#ifndef UR_DRIVER_H_
|
|
#define UR_DRIVER_H_
|
|
|
|
#include <mutex>
|
|
#include <condition_variable>
|
|
#include "ur_realtime_communication.h"
|
|
#include "ur_communication.h"
|
|
#include <vector>
|
|
#include <math.h>
|
|
#include <string>
|
|
#include <sys/types.h>
|
|
#include <sys/socket.h>
|
|
#include <netinet/in.h>
|
|
|
|
#include <chrono>
|
|
|
|
|
|
class UrDriver {
|
|
private:
|
|
double maximum_time_step_;
|
|
double minimum_payload_;
|
|
double maximum_payload_;
|
|
std::vector<std::string> joint_names_;
|
|
std::string ip_addr_;
|
|
const int MULT_JOINTSTATE_ = 1000000;
|
|
const int MULT_TIME_ = 1000000;
|
|
const unsigned int REVERSE_PORT_;
|
|
int incoming_sockfd_;
|
|
public:
|
|
UrRealtimeCommunication* rt_interface_;
|
|
UrCommunication* sec_interface_;
|
|
|
|
UrDriver(std::condition_variable& rt_msg_cond,
|
|
std::condition_variable& msg_cond, std::string host,
|
|
unsigned int reverse_port = 50007, unsigned int safety_count_max =
|
|
12, double max_time_step = 0.08, double min_payload = 0.,
|
|
double max_payload = 1.);
|
|
bool start();
|
|
void halt();
|
|
|
|
void setSpeed(double q0, double q1, double q2, double q3, double q4,
|
|
double q5, double acc = 100.);
|
|
void addTraj(
|
|
std::vector<double> inp_timestamps, //DEPRECATED
|
|
std::vector<std::vector<double> > positions,
|
|
std::vector<std::vector<double> > velocities);
|
|
void doTraj(std::vector<double> inp_timestamps,
|
|
std::vector<std::vector<double> > inp_positions,
|
|
std::vector<std::vector<double> > inp_velocities);
|
|
void stopTraj();
|
|
|
|
void uploadProg();
|
|
|
|
std::vector<double> interp_cubic(double t, double T,
|
|
std::vector<double> p0_pos, std::vector<double> p1_pos,
|
|
std::vector<double> p0_vel, std::vector<double> p1_vel);
|
|
|
|
std::vector<std::string> getJointNames();
|
|
void setJointNames(std::vector<std::string> jn);
|
|
void setToolVoltage(unsigned int v);
|
|
void setFlag(unsigned int n, bool b);
|
|
void setDigitalOut(unsigned int n, bool b);
|
|
void setAnalogOut(unsigned int n, double f);
|
|
bool setPayload(double m);
|
|
|
|
void setMinPayload(double m);
|
|
void setMaxPayload(double m);
|
|
|
|
};
|
|
|
|
#endif /* UR_DRIVER_H_ */
|