使用命令行参数

main.cpp

@@ -103,8 +103,9 @@ void uartReceive(Uart* uart){
         }else if(cnt==1 && buffer[0]=='a'){
             state = ARMOR_STATE;
             LOGM("State switch to armor!");
-        }else{
-            sscanf(buffer, "%f %f", &yaw, &pitch);
+        }else if(cnt==8){
+            memcpy(&yaw, buffer, 4);
+            memcpy(&pitch, buffer+4, 4);
             LOGM("Get yaw:%f pitch:%f", yaw, pitch);
         }
         cnt = 0;

src/camera/camera_wrapper.cpp

@@ -67,11 +67,11 @@ bool CameraWrapper::init() {
     cout<<"camera names: "<<camera_name0<<" "<<camera_name1<<endl;
 //        cout<<camera_name0<<endl;
 //        cout<<camera_name1<<endl;
-    //如果读取的相机列表不是0在左，1在右，则交换相机句柄
-//    if(strcmp(camera_name0, "camera0") != 0)
-//    {
-//        swapCameraHandle();
-//    }
+    //如果读取的相机列表不是energy在左，armor在右，则交换相机句柄
+    if(strcmp(camera_name0, "armor") != 0)
+    {
+        swapCameraHandle();
+    }
 
     //获得相机的特性描述结构体。该结构体中包含了相机可设置的各种参数的范围信息。决定了相关函数的参数
     CameraGetCapability(h_camera0, &tCapability0);