功能:绘制3D SLAM位子图/点云图

格式:SLAM_Plot(a1,a2,a3,...)

a1,a2,a3,... :为列数为3、6、7、12的矩阵变量。每一行代表一个位姿或点云位置。

说明:
1、本函数接受多个变量,因此可方便绘制多组数据。

2、变量为3列数据时,则每列代表对应点的空间绝对位置。

3、变量为6列数据时,前3列代表对应相机的旋转向量(3个轴角表示),后3列代表平移T。

4、变量为7列数据时,前4列代表对应相机的四元数表示的旋转,后3列代表平移T。

5、变量为12列数据时,前9列代表对应相机的旋转矩阵(按行依次存储9个数据),后3列代表平移T。

6、执行完毕返回绘图窗口对象
