Moving out of start position working
Working pretty well
Slam working pretty well