Add forceScale parameter to the posture generator.
User can also give an initial estimate of the force vector.
Add collision avoidance constraint with the environment.