Added trajectory publisher.
added joint index to limb index.
updates to trajectory server plus new convenience functions for converting transformations.
Updates for camera calibration and cylinder grasp planning.
Added pseudo hardware node to convert joint trajectories to states.
fixed trajectory publisher.
Added PoseArray publishing right before handing off to Ach in the trajectory server