Fix arm ik

use `std::vector<KDL::JntArray> ` instead of `KDL::JntArray` as output variable `jnt_pos_out`, and use first solution, since old function is deleted on package `pr2_arm_kinematics`.