Take out  hand implementation of modifiers, use for loop. Add an equivalency check on an object. Make calcVelocityTheta be called only from calcVelocity, do the same for force. Simplify for loop in updateValues with respect to this change.