lib/geo: bugs fixed, added function add_vector_to_global_position()
mc_pos_control: avoid global to local projections, work in global frame