previous value makes torso collide with base
tune PID values for follow_joint_trajectory controller for torso
no chance for tuning PID for follow_joint_trajectory controller for lwa4p -> currently do not use arms in urdf