Velocity loop force calc needs fixed