procress vicon data
started editing position_estimator_inav_main.c