Updated the wg06 driver so that it calls addForceTorque to register itself