Energy considerations

Added some equations to the CB model file to analyze how much energy is
lost to impact depending on leg aperture and angular velocities.