Explorar o código

change pythondecisondemo, test stop on obstacle ok. complete.

yuchuli hai 11 meses
pai
achega
d3cc912528

+ 1 - 1
src/common/modulecomm/modulecommpython.cpp

@@ -118,7 +118,7 @@ public:
 
     int SendData(np::ndarray& arr,int ndatasize)
     {
-        std::cout<<"data size is: "<<ndatasize<<std::endl;
+ //       std::cout<<"data size is: "<<ndatasize<<std::endl;
         void* data = arr.get_data();  
         char* data_ptr = static_cast<char*>(data);
         iv::modulecomm::ModuleSendMsg(mpa,data_ptr,ndatasize);

+ 4 - 4
src/python/pythondecisiondemo/decisiondemo.py

@@ -44,8 +44,8 @@ class DecisionDemo:
         nearindex = self.FindNearIndex(tracemap,msg_gpsimu)
  #       print("near index: ",nearindex)
 
-        for p in xobjarray.obj :
-            print(f"x: {p.position.x}  y: {p.position.y} ")
+ #       for p in xobjarray.obj :
+ #           print(f"x: {p.position.x}  y: {p.position.y} ")
 
         if nearindex < 0 :
             print(" not found near point, return")
@@ -207,8 +207,8 @@ class DecisionDemo:
     
 #        print("ppindex : ",ppindex)
         denominator = 2 * localpoints[ppindex].mx *(-1);
-        numerator = math.pow(localpoints[ppindex].mx,2) + pow(localpoints[ppindex].my,2);
-        fRadius = 1e9;
+        numerator = math.pow(localpoints[ppindex].mx,2) + pow(localpoints[ppindex].my,2)
+        fRadius = 1e9
         if math.fabs(denominator)>0:
             fRadius = numerator/denominator
         else: