diff --git a/franka_gripper/action/Grasp.action b/franka_gripper/action/Grasp.action index 3625ca6bc17bc9a8935803de61d2c4ab7dbba9a7..4fa487580dedca2f23cc860f890368009f3641f2 100644 --- a/franka_gripper/action/Grasp.action +++ b/franka_gripper/action/Grasp.action @@ -1,6 +1,6 @@ float64 width # [m] float64 speed # [m/s] -float64 max_current # [mA] +float64 max_force # [N] --- bool success string error diff --git a/franka_gripper/config/gripper_node_config.yaml b/franka_gripper/config/gripper_node_config.yaml index bb10ea4610a0e70467641157a50c1e71aa5c2e50..eb375d850b055cf7771b18cb011e84bf8a863af4 100644 --- a/franka_gripper/config/gripper_node_config.yaml +++ b/franka_gripper/config/gripper_node_config.yaml @@ -3,5 +3,4 @@ joint_names: - franka_emika_finger_joint1 - franka_emika_finger_joint2 width_tolerance: 0.01 # [m] -default_speed: 0.1 # [m/s] -newton_to_m_ampere_factor: 14.9 # [mA/N] +default_speed: 0.1 # [m/s] \ No newline at end of file diff --git a/franka_gripper/include/franka_gripper/franka_gripper.h b/franka_gripper/include/franka_gripper/franka_gripper.h index 4455fd24f0efe65725abf202a1a130bd590b30e4..ecae821f3620b64c6fadc3880bb753f2cc2dcd53 100644 --- a/franka_gripper/include/franka_gripper/franka_gripper.h +++ b/franka_gripper/include/franka_gripper/franka_gripper.h @@ -31,14 +31,12 @@ bool updateGripperState(const franka::Gripper& gripper, franka::GripperState* st * * @param[in] gripper A pointer to a franka gripper * @param[in] default_speed The default speed for a gripper action - * @param[in] newton_to_m_ampere_factor The mapping factor from Newton to milliampere * @param[in] action_server A pointer to a gripper action server * @param[in] goal A gripper action goal */ void gripperCommandExecuteCallback( const franka::Gripper& gripper, double default_speed, - double newton_to_m_ampere_factor, actionlib::SimpleActionServer<control_msgs::GripperCommandAction>* action_server, const control_msgs::GripperCommandGoalConstPtr& goal); diff --git a/franka_gripper/src/franka_gripper.cpp b/franka_gripper/src/franka_gripper.cpp index 53ce94ec016fa058b3851e8ba778d6e7e4f61a5f..7596ea2b9a539544692f3f6d21850d4596829fd2 100644 --- a/franka_gripper/src/franka_gripper.cpp +++ b/franka_gripper/src/franka_gripper.cpp @@ -28,7 +28,6 @@ bool updateGripperState(const franka::Gripper& gripper, franka::GripperState* st void gripperCommandExecuteCallback( const franka::Gripper& gripper, double default_speed, - double newton_to_m_ampere_factor, actionlib::SimpleActionServer<control_msgs::GripperCommandAction>* action_server, const control_msgs::GripperCommandGoalConstPtr& goal) { std::function<bool()> gripper_command_handler = [=, &gripper]() { @@ -41,8 +40,7 @@ void gripperCommandExecuteCallback( if (goal->command.position >= state.width) { return gripper.move(goal->command.position, default_speed); } - return gripper.grasp(goal->command.position, default_speed, - goal->command.max_effort * newton_to_m_ampere_factor); + return gripper.grasp(goal->command.position, default_speed, goal->command.max_effort); }; try { @@ -77,7 +75,7 @@ bool stop(const franka::Gripper& gripper, const StopGoalConstPtr& /*goal*/) { } bool grasp(const franka::Gripper& gripper, const GraspGoalConstPtr& goal) { - return gripper.grasp(goal->width, goal->speed, goal->max_current); + return gripper.grasp(goal->width, goal->speed, goal->max_force); } } // namespace franka_gripper diff --git a/franka_gripper/src/franka_gripper_node.cpp b/franka_gripper/src/franka_gripper_node.cpp index 9ad8f43a06fea2c0884d00c6a94689f92346be59..407fc52656273dc9fb7e03bd2cfdeac9ada9f857 100644 --- a/franka_gripper/src/franka_gripper_node.cpp +++ b/franka_gripper/src/franka_gripper_node.cpp @@ -73,12 +73,6 @@ int main(int argc, char** argv) { ROS_INFO_STREAM("franka_gripper_node: Found default_speed" << default_speed); } - double newton_to_m_ampere_factor(14.9); - if (node_handle.getParam("newton_to_m_ampere_factor", newton_to_m_ampere_factor)) { - ROS_INFO_STREAM("franka_gripper_node: Found newton_to_m_ampere_factor" - << newton_to_m_ampere_factor); - } - franka::Gripper gripper(robot_ip); std::function<bool(const HomingGoalConstPtr&)> homing_handler = @@ -114,7 +108,7 @@ int main(int argc, char** argv) { SimpleActionServer<GripperCommandAction> gripper_command_action_server( node_handle, "gripper_action", std::bind(&gripperCommandExecuteCallback, std::cref(gripper), default_speed, - newton_to_m_ampere_factor, &gripper_command_action_server, std::placeholders::_1), + &gripper_command_action_server, std::placeholders::_1), false); homing_action_server_.start();