Combine multiplication steps in getForce to improve performance by about 8% when dragging the leg, see #18