Update to new ControlMode2 and InteractionMode interface

ControlMode2 has been implemented
InteractionMode stores the new value and returns it back but does not
change behaviour of the robot