Some improvements to efficiency#290

rhaschke wants to merge 3 commits intofrankarobotics:developfrankarobotics/franka_ros:developfrom

rhaschke:improve-efficiencyrhaschke/franka_ros:improve-efficiencyCopy head branch name to clipboard