mirror of
https://gitlab.com/obbart/universal_robots_ros_driver.git
synced 2026-04-10 10:00:48 +02:00
Checking for acceleration in actionGoal input. Adjusted sweet spot for max_time_step
This commit is contained in:
@@ -31,7 +31,7 @@ public:
|
|||||||
UrCommunication* sec_interface_;
|
UrCommunication* sec_interface_;
|
||||||
|
|
||||||
UrDriver(std::condition_variable& rt_msg_cond, std::condition_variable& msg_cond, std::string host,
|
UrDriver(std::condition_variable& rt_msg_cond, std::condition_variable& msg_cond, std::string host,
|
||||||
unsigned int safety_count_max = 12, double max_time_step = 0.08,
|
unsigned int safety_count_max = 12, double max_time_step = 0.24,
|
||||||
double min_payload = 0., double max_payload = 1.);
|
double min_payload = 0., double max_payload = 1.);
|
||||||
void start();
|
void start();
|
||||||
void halt();
|
void halt();
|
||||||
|
|||||||
@@ -57,10 +57,10 @@ void UrDriver::addTraj(std::vector<double> inp_timestamps,
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
//make sure we come to a smooth stop
|
//make sure we come to a smooth stop
|
||||||
while (timestamps.back() < inp_timestamps.back()) {
|
/*while (timestamps.back() < inp_timestamps.back()) {
|
||||||
timestamps.push_back(timestamps.back() + 0.008);
|
timestamps.push_back(timestamps.back() + 0.008);
|
||||||
}
|
}
|
||||||
timestamps.pop_back();
|
timestamps.pop_back();*/
|
||||||
|
|
||||||
unsigned int j = 0;
|
unsigned int j = 0;
|
||||||
for (unsigned int i = 0; i < timestamps.size(); i++) {
|
for (unsigned int i = 0; i < timestamps.size(); i++) {
|
||||||
|
|||||||
@@ -271,6 +271,7 @@ private:
|
|||||||
traj.points[i].positions[mapping[j]]);
|
traj.points[i].positions[mapping[j]]);
|
||||||
new_point.velocities.push_back(
|
new_point.velocities.push_back(
|
||||||
traj.points[i].velocities[mapping[j]]);
|
traj.points[i].velocities[mapping[j]]);
|
||||||
|
if (traj.points[i].accelerations.size() != 0)
|
||||||
new_point.accelerations.push_back(
|
new_point.accelerations.push_back(
|
||||||
traj.points[i].accelerations[mapping[j]]);
|
traj.points[i].accelerations[mapping[j]]);
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user