Modified sign miss in old TwoDofController
Debugged config parameter index miss and added isDebug