Made stuff work with the current robot config. Also edited the controls a little.