Add flag to check if the control strategy has been updated
Wait for FRI feedback when switching control mode
Add fri mode flag
Go back to position control mode when stopping KRL script
Always send joint position command in friExampleTorque