Modified controller arguments from double valiables to struct parameter.
Added old style parameter functions to TwoDofController for Stabilizer