Wrote robot controller callbacks