Fixed bad scaling
Added default value>0 for sim
torque, torque_gc and velocity control now works in simulation