Code: Select all
void initLCD() {
blinkLED(20,30,1);
#if defined(LCD_TEXTSTAR)
// Cat's Whisker Technologies 'TextStar' Module CW-LCD-02
// http://cats-whisker.com/resources/documents/cw-lcd-02_datasheet.pdf
// Modified by Luca Brizzi aka gtrick90 @ RCG
LCDprint(0xFE);LCDprint(0x43);LCDprint(0x02); //cursor blink mode
LCDprint(0x0c); //clear screen
LCDprintChar("\n\n\n\n ");
LCDprintChar("MultiWii: CONFIG PARAMS");
LCDprintChar("");
delay(2500);
LCDprint(0x0c); //clear screen
#else
Serial.end();
//init LCD
PINMODE_LCD //TX PIN for LCD = Arduino RX PIN (more convenient to connect a servo plug on arduino pro mini)
#endif
}
void configurationLoop() {
uint8_t chan,i;
uint8_t param,paramActive;
uint8_t val,valActive;
static char line1[17],line2[17];
uint8_t LCD=1;
uint8_t refreshLCD = 1;
typedef struct {
char* paramText;
uint8_t* var;
uint8_t decimal;
uint8_t increment;
} paramStruct;
static paramStruct p[] = {
{"PITCH&ROLL P", &P8[ROLL],1,1},
{"ROLL P", &P8[ROLL],1,1}, {"ROLL I", &I8[ROLL],3,5}, {"ROLL D", &D8[ROLL],0,1},
{"PITCH P", &P8[PITCH],1,1}, {"PITCH I", &I8[PITCH],3,5}, {"PITCH D", &D8[PITCH],0,1},
{"YAW P", &P8[YAW],1,1}, {"YAW I", &I8[YAW],3,5}, {"YAW D", &D8[YAW],0,1},
{"LEVEL P", &PLEVEL8,1,1}, {"LEVEL I", &ILEVEL8,3,5},
{"RC RATE", &rcRate8,2,2}, {"RC EXPO", &rcExpo8,2,2},
{"PITCH&ROLL RATE", &rollPitchRate,2,2}, {"YAW RATE", &yawRate,2,2},
{"THROTTLE PID", &dynThrPID,2,2},
};
initLCD();
param = 0;
while (LCD == 1) {
if (refreshLCD == 1) {
strcpy(line2," ");
strcpy(line1," ");
i=0; char* point = p[param].paramText; while (*point) line1[i++] = *point++;
uint16_t unit = *p[param].var;
if (param == 12) {unit *=2;} // RC RATE can go up to 500
char c1 = '0'+unit/100; char c2 = '0'+unit/10-(unit/100)*10; char c3 = '0'+unit-(unit/10)*10;
if (p[param].decimal == 0) {line2[6] = c1; line2[7] = c2; line2[8] = c3;}
if (p[param].decimal == 1) {line2[5] = c1; line2[6] = c2; line2[7] = '.'; line2[8] = c3;}
if (p[param].decimal == 2) {line2[5] = c1; line2[6] = '.'; line2[7] = c2; line2[8] = c3;}
if (p[param].decimal == 3) {line2[4] = '0'; line2[5] = '.'; line2[6] = c1; line2[7] = c2; line2[8] = c3;}
#if defined(LCD_TEXTSTAR)
LCDprint(0x0c); //clear screen
//LCDprint(0xFE);LCDprint('L');LCDprint(1);
LCDprintChar("\n\n\n\n ");
LCDprintChar(line1); //refresh line 1 of LCD
//LCDprint(0xFE);LCDprint('L');LCDprint(2);
LCDprintChar(line2); //refresh line 2 of LCD
#else
LCDprint(0xFE);LCDprint(128);LCDprintChar(line1);
LCDprint(0xFE);LCDprint(192);LCDprintChar(line2);
#endif
refreshLCD=0;
}
for (chan = ROLL; chan < 4; chan++) rcData[chan] = readRawRC(chan);
//switch config param with pitch
if (rcData[PITCH] < MINCHECK && paramActive == 0 && param<16) {
paramActive = 1;refreshLCD=1;blinkLED(10,20,1);
param++;
}
if (rcData[PITCH] > MAXCHECK && paramActive == 0 && param>0) {
paramActive = 1;refreshLCD=1;blinkLED(10,20,1);
param--;
}
if (rcData[PITCH] < MAXCHECK && rcData[PITCH] > MINCHECK) paramActive = 0;
//+ or - param with low and high roll
if (rcData[ROLL] < MINCHECK && valActive == 0 && *p[param].var>p[param].increment-1) {
valActive = 1;refreshLCD=1;blinkLED(10,20,1);
*p[param].var -= p[param].increment; //set val -
if (param == 0) *p[4].var = *p[0].var; //PITCH P
}
if (rcData[ROLL] > MAXCHECK && valActive == 0) {
valActive = 1;refreshLCD=1;blinkLED(10,20,1);
*p[param].var += p[param].increment; //set val +
if (param == 0) *p[4].var = *p[0].var; //PITCH P
}
if (rcData[ROLL] < MAXCHECK && rcData[ROLL] > MINCHECK) valActive = 0;
if (rcData[YAW] < MINCHECK && rcData[PITCH] > MAXCHECK) LCD = 0;
}
#if defined(LCD_TEXTSTAR)
blinkLED(20,30,1);
LCDprint(0x0c); //clear screen
LCDprintChar("\n\n\n\n ");
LCDprintChar("Saving Settings...");
#endif
writeParams();
#if defined(LCD_TEXTSTAR)
LCDprintChar("..done! Exit.");
#else
Serial.begin(SERIAL_COM_SPEED);
#endif
}
Hamburger wrote:You should probably use a terminal program of your choice on the phone and enable vt100 mode in mwii.
I have no experience with shortcomings of iphone, so jailbreak may be neccessary.
without jailbreak
