ivlocalplan_simple.cpp 611 B

123456789101112131415161718192021222324
  1. #include "ivlocalplan_simple.h"
  2. #include <iostream>
  3. ivlocalplan_simple::ivlocalplan_simple()
  4. {
  5. }
  6. std::vector<iv::Point2D> ivlocalplan_simple::GetLocalPlan(iv::GPS_INS now_gps_ins,int nPathPointIndex ,double fSpeed,std::vector<iv::GPSData> gpsMapLine,
  7. iv::LidarGridPtr lidarGridPtr)
  8. {
  9. std::vector<iv::Point2D> xvectorplan;
  10. xvectorplan.clear();
  11. if(nPathPointIndex<0)
  12. {
  13. std::cout<<" ivlocalplan_simple::GetLocalPlan pathpoint<0. pathpoint = "<<nPathPointIndex<<std::endl;
  14. return xvectorplan;
  15. }
  16. return xvectorplan;
  17. }