force torque working commit.
contactSensorTest now passes.
Merge pull request #287 from mposa/master

ContactForceTorqueSensor update