linxiangup的博客

puresuit算法 C++实现（ROS RVIZ 环境下展示）#include<iostream>#include<cstring>#include<stdlib.h>#include<vector>#include<math.h>#include<cmath>#include <ros/ros.h>#include <visualization_msgs/Marker.h>//#includ

C++实现一个点到曲线的最近距离求解（遍历法）#include<iostream>#include<cstring>#include<stdlib.h>#include<vector>#include<algorithm>#include<math.h>using namespace std;int main (){ //创建结构体，该点的位置以及速度、航向（速度和航向其他程序会用） struct ve