Improved the function 'refineInitialConditions' by allowing the
orientation of the foot to change by delta about the nominal, and
by scaling this delta by 1/1000 in the function (as the function is
very very sensitive to changes in these variables).

Signed-off-by: mjhmilla <millard.matthew@gmail.com>