Added a new osim-model with muscles for further testing and generalizing the controller methods
(+ added some setting for visualizer background for later use)
Some clean-up to keep the code generic for models with diff number of actuators
Some more prints for debugging
Cleaning and generalization also in WBOptimize
Solved the super-bug of right/left asymmetry in subtalar torque