Added base code

Copy of other autonomous program