moved changeMode() and toggleControl() in init() function from begining of the function to the end. Added comunication for mode change - added sendChangeMode(mode) and modified changeMode to call this function on operator side. On the robot side added change_mode(mode)
resolved merge conflict in changeMode() - robotFrame -> robotIcon