Fixed bugs and problems in the TeleOp