update @huiyu
This commit is contained in:
@@ -240,8 +240,8 @@ int RmArmDriverAndKinematics::computeMovingTrajectory(NodataTrajectory *newTraje
|
||||
for (int i = 0; i < USED_ARM_DOF; ++i) {
|
||||
joints[i] = end[i];
|
||||
}
|
||||
rm_movej(robotHandle, joints, 20, 1, 0, 0);
|
||||
return 0;
|
||||
return rm_movej(robotHandle, joints, 18, 1, 0, 0);
|
||||
// return 0;
|
||||
}
|
||||
|
||||
int RmArmDriverAndKinematics::computeSteppingTrajectory(NodataTrajectory *newTrajectory, const float *start, const float *speed, int armId)
|
||||
|
||||
@@ -244,6 +244,7 @@ int RmArmHandler::StartNewTrajectory()
|
||||
int result = trapezoidalTrajectory_->computeTrajectory(start, goal, goalType);
|
||||
if (result != 0) {
|
||||
goalManager_->GoalRunOff();
|
||||
RCLCPP_ERROR(rclcpp::get_logger(GET_FUNC_LINE_STR()), "computeTrajectory Failed, GoalRunOff.");
|
||||
}
|
||||
/*Trajectory* nowTrajectory = trapezoidalTrajectory_->getNowTrajectory();
|
||||
RCLCPP_INFO(rclcpp::get_logger(GET_FUNC_LINE_STR()), "Pose stepping continue. accs:%d, unis:%d, vels:%f, %f, %f, %f, %f, %f",
|
||||
|
||||
Reference in New Issue
Block a user