Fetch current step from current joint state
Constantly updating joint positions