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 + ' '; |