add matrix copyTo

src/lib/matrix

src/modules/ekf2/ekf2_main.cpp

src/modules/fw_att_control/fw_att_control_main.cpp

src/modules/fw_pos_control_l1/fw_pos_control_l1_main.cpp

src/modules/mavlink/mavlink_receiver.cpp

src/modules/simulator/simulator_mavlink.cpp