replace geo _wrap_pi with matrix::wrap_pi

src/examples/bottle_drop/bottle_drop.cpp

src/examples/segway/blocks.cpp

src/lib/ecl

...odules/attitude_estimator_q/attitude_estimator_q_main.cpp

src/modules/mavlink/mavlink_high_latency2.cpp

src/modules/mavlink/mavlink_messages.cpp

src/modules/mavlink/mavlink_mission.cpp

src/modules/mavlink/mavlink_receiver.cpp

src/modules/mc_pos_control/mc_pos_control_main.cpp

src/modules/navigator/follow_target.cpp

src/modules/navigator/mission.cpp

src/modules/navigator/mission_block.cpp

src/modules/vtol_att_control/standard.cpp

src/platforms/ros/geo.cpp