updated autonomous

TODO: calibrate elevator