Added a switch in impedanceControl for better suited gains when using Gazebo and better error checking when jointTorqueControl is not active