Added higher level functions to controller
zero() reset the kalman filter
Added initial autonomy mission class
Fixed examples to use new mission API