Add method to connect/disconnect robot from controller