| 95,9 → 95,8 |
|---|
| { "Status " , 0, 1000, 200, 0, " ", {"SAT ","Time ","Magnet","Camera","Logs "},0, 0}, // 0 |
| { "Load Waypoint List " , 1, 99, 1, 0, "Select List ", {"Fixed "," ","Relati"," "," "},1, ML_EDIT }, // 1 |
| { "Load single Position " , 1, 99, 1, 0, "Load from Index:", {" "," "," "," ","Load "},1, ML_EDIT}, // 2 |
| { "Store single Position" , 1, 99, 1, 0, "Store on Index: ", {" "," "," "," ","Store "},1, ML_EDIT} // 3 |
| |
| // { "All Characters " , 0, 256, 20, 3, "Slider + Send ", {" "," "," "," "," "},3, ML_SEND | ML_SLIDER} // 4 |
| { "Store single Position" , 1, 99, 1, 0, "Store on Index: ", {" "," "," "," ","Store "},1, ML_EDIT}, // 3 |
| { "BL-Gimbal Control " , -150, 150, 0, 0, "Move ", {"Yaw ","Nick "," "," ","Reset "},1, ML_WHEEL_RELATIV} // 4 |
| }; |
| |
| |
| 131,6 → 130,8 |
|---|
| s32 i1,i2; |
| u8 sign; |
| Mobile_Clear(); |
| FromMenuGimbalYaw = 0; // will be set in the menu below |
| FromMenuServoNickControl = 0; |
| switch(item) |
| { |
| // Version Info |
| 307,7 → 308,47 |
|---|
| } |
| break; |
| case 4: |
| Mobile_printfxy(0,0,"GimbalCtrl"); |
| Mobile.ReturnValue = 0; |
| if(!(FromGimbalCtrl.GimbalStatus & GIMBAL_I2C_OK)) |
| { |
| Mobile_printfxy(0,2,"Not connected"); |
| if(GimbalCtrlTimeout < 10) Mobile_printfxy(14,4,"(conn)"); // connect manually |
| if(Keys & KEY5) GimbalCtrlTimeout = 65000; |
| } |
| else |
| { |
| static u8 control = 0; |
| Mobile_printfxy(10,0,"V%i.%02i",1 + FromGimbalCtrl.Version / 100, FromGimbalCtrl.Version % 100); |
| Mobile_printfxy(0,1,"Stat:"); |
| if(FromGimbalCtrl.GimbalStatus & GIMBAL_DATA_OK) Mobile_printfxy(8,1,"OK") else Mobile_printfxy(5,1,"No Gimbal"); |
| Mobile_printfxy(0,2,"Nick:%3i Roll:%3i",FromGimbalCtrl.Nick,FromGimbalCtrl.Roll); |
| Mobile_printfxy(0,3,"Yaw: %3i [0,1 Deg]",FromGimbalCtrl.Yaw); |
| if(control == 0) |
| { |
| Mobile_printfxy(0,4,"Control: Yaw"); |
| FromMenuServoNickControl = 0; |
| FromMenuGimbalYaw = Value * (-2); |
| } |
| else |
| { |
| Mobile_printfxy(0,4,"Control: Nick"); |
| FromMenuServoNickControl = Value; |
| FromMenuGimbalYaw = 0; |
| } |
| |
| if(Keys & KEY5) |
| { |
| ToGimbalCtrl.BitCmd |= (GIMBAL_CMD_YW_ZERO); |
| FromMenuGimbalYaw = 0; |
| MenuNickGimbalOffset = 0; |
| } |
| if(Keys & KEY1) control = 0; |
| if(Keys & KEY2) control = 1; |
| } |
| break; |
| case 99: |
| { |
| static u16 offset = 20, tmp; |
| // Mobile_printfxy(0,0,"Testpage %i %c",item,33); |
| for(sign = 0; sign < 21*5; sign++) Mobile.DisplayBuff[sign] = sign + ' '; |