Corrected position listener to only listen to proper joint_state messages