Merge tra3dpy -> navipy

Add resources such as 3 body marked bee of learning flight in Doussot 2017
Calibration of Doussot 2018a

navipy/resources/sample_experiment/Doussot_2018a/calib_20180117_cam_0.xml

+<?xml version="1.0" encoding="utf-8"?>
+<opencv_storage>
+   <intrinsic_matrix type_id="opencv-matrix">
+      <rows>3</rows>
+      <cols>3</cols>
+      <dt>d</dt>
+      <data>
+4.936492100794874204e+03 4.482787346440770193e+01 7.011009249365223468e+02 0.000000000000000000e+00 4.959734853887563077e+03 6.911974716439037820e+02 0.000000000000000000e+00 0.000000000000000000e+00 1.000000000000000000e+00 </data>
+   </intrinsic_matrix>
+   <distortion type_id="opencv-matrix">
+      <rows>1</rows>
+      <cols>5</cols>
+      <dt>d</dt>
+      <data>
+9.540158264846680669e-02 -1.912732811790514686e+00 -8.176110857835615039e-05 -2.867843702531089854e-03 1.884825476082453832e+01 </data>
+   </distortion>
+</opencv_storage>
\ No newline at end of file

navipy/resources/sample_experiment/Doussot_2018a/calib_20180117_cam_2.xml

+<?xml version="1.0" encoding="utf-8"?>
+<opencv_storage>
+   <intrinsic_matrix type_id="opencv-matrix">
+      <rows>3</rows>
+      <cols>3</cols>
+      <dt>d</dt>
+      <data>
+7.455928023583999675e+03 1.663099781309645948e+02 1.200110022679696613e+03 0.000000000000000000e+00 7.483774160994740669e+03 5.370960220684764863e+02 0.000000000000000000e+00 0.000000000000000000e+00 1.000000000000000000e+00 </data>
+   </intrinsic_matrix>
+   <distortion type_id="opencv-matrix">
+      <rows>1</rows>
+      <cols>5</cols>
+      <dt>d</dt>
+      <data>
+-3.868778953894962402e-01 2.630511096952200134e+01 -2.724768757758080050e-03 -2.522850000343333093e-03 -4.775921906956544376e+02 </data>
+   </distortion>
+</opencv_storage>
\ No newline at end of file

navipy/resources/sample_experiment/Doussot_2018a/full_calibration_20180117.xml

+<?xml version="1.0"?>
+<opencv_storage>
+<ncameras>2.</ncameras>
+ <!-- resumed -->
+
+<pose_0 type_id="opencv-matrix">
+  <rows>4</rows>
+  <cols>4</cols>
+  <dt>d</dt>
+  <data>
+    -8.5985979319991057e-01 5.1039636880966011e-01
+    1.1691139556110175e-02 -2.3391826285744909e+01
+    -4.3340563407281851e-01 -7.4187403448916456e-01
+    5.1164682477731449e-01 5.6019926661767432e+00 2.6981603434960111e-01
+    4.3487752719206269e-01 8.5911631572865077e-01
+    -8.2221407744566261e+02 0. 0. 0. 1.</data></pose_0>
+ <!-- resumed -->
+
+<intrinsic_matrix_0 type_id="opencv-matrix">
+  <rows>3</rows>
+  <cols>3</cols>
+  <dt>d</dt>
+  <data>
+    4.9364921007948742e+03 4.4827873464407702e+01 7.0110092493652235e+02
+    0. 4.9597348538875631e+03 6.9119747164390378e+02 0. 0. 1.</data></intrinsic_matrix_0>
+ <!-- resumed -->
+
+<distortion_0 type_id="opencv-matrix">
+  <rows>1</rows>
+  <cols>5</cols>
+  <dt>d</dt>
+  <data>
+    9.5401582648466807e-02 -1.9127328117905147e+00
+    -8.1761108578356150e-05 -2.8678437025310899e-03
+    1.8848254760824538e+01</data></distortion_0>
+ <!-- resumed -->
+
+<pose_1 type_id="opencv-matrix">
+  <rows>4</rows>
+  <cols>4</cols>
+  <dt>d</dt>
+  <data>
+    3.2261530530841931e-01 -7.7163618529742328e-01
+    -5.4817603223818168e-01 5.4266732910883398e+01
+    9.1523260483009705e-01 4.0200399836675360e-01
+    -2.7240858155694492e-02 -2.4563414508364964e+01
+    2.4138898864005973e-01 -4.9292026012001561e-01
+    8.3591923851921568e-01 -9.5770955691903600e+02 0. 0. 0. 1.</data></pose_1>
+ <!-- resumed -->
+
+<intrinsic_matrix_1 type_id="opencv-matrix">
+  <rows>3</rows>
+  <cols>3</cols>
+  <dt>d</dt>
+  <data>
+    7.4559280235839997e+03 1.6630997813096459e+02 1.2001100226796966e+03
+    0. 7.4837741609947407e+03 5.3709602206847649e+02 0. 0. 1.</data></intrinsic_matrix_1>
+ <!-- resumed -->
+
+<distortion_1 type_id="opencv-matrix">
+  <rows>1</rows>
+  <cols>5</cols>
+  <dt>d</dt>
+  <data>
+    -3.8687789538949624e-01 2.6305110969522001e+01
+    -2.7247687577580800e-03 -2.5228500003433331e-03
+    -4.7759219069565444e+02</data></distortion_1>
+</opencv_storage>

navipy/resources/sample_experiment/Doussot_2018a/manhattan_cam_0_xypts.csv

+cam1_X,cam1_Y
+NaN,NaN
+475.580929,38.498723
+312.568887,246.394285
+145.537402,468.996899
+NaN,NaN
+379.018977,75.055817
+NaN,NaN
+730.604493,155.504343
+577.370122,384.489591
+417.973654,608.031824
+243.490565,851.547395
+1147.473005,74.583664
+998.049653,283.902373
+687.454889,755.549733
+515.505013,991.392121
+NaN,NaN
+1273.477722,417.867646
+1124.796532,662.985248
+964.628145,890.034080
+NaN,NaN
+NaN,NaN
+NaN,NaN
+NaN,NaN
+NaN,NaN
+NaN,NaN
+NaN,NaN
+NaN,NaN

navipy/resources/sample_experiment/Doussot_2018a/manhattan_cam_2_xypts.csv

+cam2_X,cam2_Y
+NaN,NaN
+909.428011,1644.524026
+1228.045152,1459.521071
+1505.015132,1291.481746
+NaN,NaN
+1433.412847,1405.537777
+438.007145,1479.005384
+784.908891,1290.859562
+1086.510428,1105.478183
+1387.537128,935.006497
+1672.143091,771.953455
+286.521107,1099.03502
+640.024625,921.974856
+1252.987954,585.005517
+1561.080428,434.454662
+129.055688,706.935533
+492.039556,537.031817
+818.556277,366.00564
+1145.430818,220.52988
+1448.60998,72.934707
+360.546917,380.917861
+NaN,NaN
+NaN,NaN
+327.016875,144.024381
+NaN,NaN
+NaN,NaN
+NaN,NaN