Add current WIP autonomous
Add scissor lift and sweeper control