Exemplo n.º 1
0
 def difference(self,a,b):
     w = se3.error(a,b)
     return so3.cross_product(w[:3])+w[3:]
Exemplo n.º 2
0
 def difference(self, a, b):
     w = se3.error(a, b)
     return so3.cross_product(w[:3]) + w[3:]
Exemplo n.º 3
0
 def distance(self,a,b):
     return vectorops.norm(se3.error((a[:9],a[9:]),(b[:9],b[9:])))
Exemplo n.º 4
0
 def distance(self, a, b):
     return vectorops.norm(se3.error((a[:9], a[9:]), (b[:9], b[9:])))