added function to grab joint positions for world joint