fixed collisions and implemented working controls. Bumpers are not implemented. Default robot now no longer slips laterally