Shape transform changes
Implemented joint setup.
Removing bodies with joints connected, invalidating joints.
Roughly implemented more joint types.