Added switch block in sendPacket(RobotPacket) in Control