ROS知识点(9)_利用Eigen求解平方根
eg.点A(x1,y1) 点B(x2,y2),求解两点间距离
Eigen::Vector2f rad_dir(x1-x2,y1-y2);
Eigen::Vector2f Q=rad_dir.cwiseProduct(rad_dir);
//该表达式完成的功能是将rad_dir*rad_dir的对应点相乘。
//Q=((x1-x2)^2,(y1-y2)^2)
double a=Q.sum();
//该步实现的是a=(x1-x2)^2+(y1-y2)^2
double b=sqrt(a);
//该步实现的是b=
原创
2021-08-07 21:48:59 ·
884 阅读 ·
0 评论