首先已知器械A和B在统一坐标系下的位姿,求器械B在器械A空间下的位子信息
// 首先获取参考工具A的位姿
vtkSmartPointer<vtkMatrix4x4> MatriA = vtkSmartPointer<vtkMatrix4x4>::New();
for(int i = 0; i < 4; j++)
{
for(int j = 0; j < 4; j++)
{
double val = 0;
val = data[i].MatrixSrcA[j][k]
首先已知器械A和B在统一坐标系下的位姿,求器械B在器械A空间下的位子信息
// 首先获取参考工具A的位姿
vtkSmartPointer<vtkMatrix4x4> MatriA = vtkSmartPointer<vtkMatrix4x4>::New();
for(int i = 0; i < 4; j++)
{
for(int j = 0; j < 4; j++)
{
double val = 0;
val = data[i].MatrixSrcA[j][k]