def log(p):
q = p.rot
t = p.trans
r = quat.log(q)
D = quat.dlog(r)
return np.vstack((r, D * t))
微信
公众号
扫码关注公众号
微信
公众号