Add robot health and update/phase controller