Fixed body for skeleton

Reverted to Bob's original code. Will fix through visualization.