Started pseudo coding autonomous

Planning for autonomous