cleanup and added polling joint positions in depth space