added rigid body diagram