WebSVN - FlightCtrl - Diff - Rev 909 and 916 - /branches/V0.69k CRK HexaLotte/menu.c



           }

 
           break;
    case 2:// Attitude Menu Item
           LCD_printfxy(0,0,"Attitude");
           LCD_printfxy(0,1,"Nick:     %5i",IntegralNick/1024);
           LCD_printfxy(0,2,"Roll:      %5i",IntegralRoll/1024);
           LCD_printfxy(0,3,"Heading:   %5i",CompassHeading);
           break;
    case 3:// Remote Control Channel Menu Item
           LCD_printfxy(0,0,"C1:%4i  C2:%4i ",PPM_in[1],PPM_in[2]);
           LCD_printfxy(0,1,"C3:%4i  C4:%4i ",PPM_in[3],PPM_in[4]);
           LCD_printfxy(0,2,"C5:%4i  C6:%4i ",PPM_in[5],PPM_in[6]);
           LCD_printfxy(0,3,"C7:%4i  C8:%4i ",PPM_in[7],PPM_in[8]);
           break;
    case 4:// Remote Control Mapping Menu Item
           LCD_printfxy(0,0,"Ni:%4i  Ro:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_NICK]],PPM_in[ParamSet.ChannelAssignment[CH_ROLL]]);
           LCD_printfxy(0,1,"Gs:%4i  Ya:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_GAS]],PPM_in[ParamSet.ChannelAssignment[CH_YAW]]);
           LCD_printfxy(0,2,"P1:%4i  P2:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI1]],PPM_in[ParamSet.ChannelAssignment[CH_POTI2]]);
           LCD_printfxy(0,3,"P3:%4i  P4:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI3]],PPM_in[ParamSet.ChannelAssignment[CH_POTI4]]);
           break;
    case 5:// Gyro Sensor Menu Item
           LCD_printfxy(0,0,"Gyro - Sensor");
          if(BoardRelease == 10)
          {
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick);
           LCD_printfxy(0,2,"Roll  %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
           LCD_printfxy(0,3,"Yaw   %4i (%3i)",Reading_GyroYaw, AdNeutralYaw);
          }
          else
          {
           LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick/2);
           LCD_printfxy(0,2,"Roll  %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
           LCD_printfxy(0,3,"Yaw   %4i (%3i)",Reading_GyroYaw, AdNeutralYaw/2);
          }
           break;
    case 6:// Acceleration Sensor Menu Item
           LCD_printfxy(0,0,"ACC - Sensor");
           LCD_printfxy(0,1,"Nick  %4i (%3i)",AdValueAccNick, NeutralAccX);
           LCD_printfxy(0,2,"Roll   %4i (%3i)",AdValueAccRoll, NeutralAccY);
           LCD_printfxy(0,3,"Height %4i (%3i)",Mean_AccTop, (int)NeutralAccZ);
           break;
    case 7:// Accumulator Voltage / Remote Control Level

                   LCD_printfxy(0,2,"Po3: %3i Po7: %3i" ,Poti3,Poti7); //PPM24-Extesion
                   LCD_printfxy(0,3,"Po4: %3i Po8: %3i" ,Poti4,Poti8); //PPM24-Extesion
           break;
    case 10:// Servo Menu Item
           LCD_printfxy(0,0,"Servo  " );
           LCD_printfxy(0,1,"Setpoint  %3i",FCParam.ServoNickControl);
           LCD_printfxy(0,2,"Position: %3i",ServoValue);
           LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoNickMin, ParamSet.ServoNickMax);
           break;
    case 11://Extern Control
           LCD_printfxy(0,0,"ExternControl  " );
           LCD_printfxy(0,1,"Ni:%4i  Ro:%4i ",ExternControl.Nick, ExternControl.Roll);
           LCD_printfxy(0,2,"Gs:%4i  Ya:%4i ",ExternControl.Gas, ExternControl.Yaw);
           LCD_printfxy(0,3,"Hi:%4i  Cf:%4i ",ExternControl.Height, ExternControl.Config);
           break;

 
    #if defined (USE_KILLAGREG) || defined (USE_MK3MAG)

Rev 909	Rev 916
Line 119...	Line 119...
119	}	119	}
Line 120...	Line 120...
120		120
121	break;	121	break;
122	case 2:// Attitude Menu Item	122	case 2:// Attitude Menu Item
123	LCD_printfxy(0,0,"Attitude");	123	LCD_printfxy(0,0,"Attitude");
124	LCD_printfxy(0,1,"Pitch: %5i",IntegralPitch/1024);	124	LCD_printfxy(0,1,"Nick: %5i",IntegralNick/1024);
125	LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);	125	LCD_printfxy(0,2,"Roll: %5i",IntegralRoll/1024);
126	LCD_printfxy(0,3,"Heading: %5i",CompassHeading);	126	LCD_printfxy(0,3,"Heading: %5i",CompassHeading);
127	break;	127	break;
128	case 3:// Remote Control Channel Menu Item	128	case 3:// Remote Control Channel Menu Item
129	LCD_printfxy(0,0,"C1:%4i C2:%4i ",PPM_in[1],PPM_in[2]);	129	LCD_printfxy(0,0,"C1:%4i C2:%4i ",PPM_in[1],PPM_in[2]);
130	LCD_printfxy(0,1,"C3:%4i C4:%4i ",PPM_in[3],PPM_in[4]);	130	LCD_printfxy(0,1,"C3:%4i C4:%4i ",PPM_in[3],PPM_in[4]);
131	LCD_printfxy(0,2,"C5:%4i C6:%4i ",PPM_in[5],PPM_in[6]);	131	LCD_printfxy(0,2,"C5:%4i C6:%4i ",PPM_in[5],PPM_in[6]);
132	LCD_printfxy(0,3,"C7:%4i C8:%4i ",PPM_in[7],PPM_in[8]);	132	LCD_printfxy(0,3,"C7:%4i C8:%4i ",PPM_in[7],PPM_in[8]);
133	break;	133	break;
134	case 4:// Remote Control Mapping Menu Item	134	case 4:// Remote Control Mapping Menu Item
135	LCD_printfxy(0,0,"Pi:%4i Ro:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_PITCH]],PPM_in[ParamSet.ChannelAssignment[CH_ROLL]]);	135	LCD_printfxy(0,0,"Ni:%4i Ro:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_NICK]],PPM_in[ParamSet.ChannelAssignment[CH_ROLL]]);
136	LCD_printfxy(0,1,"Gs:%4i Ya:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_THRUST]],PPM_in[ParamSet.ChannelAssignment[CH_YAW]]);	136	LCD_printfxy(0,1,"Gs:%4i Ya:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_GAS]],PPM_in[ParamSet.ChannelAssignment[CH_YAW]]);
137	LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI1]],PPM_in[ParamSet.ChannelAssignment[CH_POTI2]]);	137	LCD_printfxy(0,2,"P1:%4i P2:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI1]],PPM_in[ParamSet.ChannelAssignment[CH_POTI2]]);
138	LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI3]],PPM_in[ParamSet.ChannelAssignment[CH_POTI4]]);	138	LCD_printfxy(0,3,"P3:%4i P4:%4i ",PPM_in[ParamSet.ChannelAssignment[CH_POTI3]],PPM_in[ParamSet.ChannelAssignment[CH_POTI4]]);
139	break;	139	break;
140	case 5:// Gyro Sensor Menu Item	140	case 5:// Gyro Sensor Menu Item
141	LCD_printfxy(0,0,"Gyro - Sensor");	141	LCD_printfxy(0,0,"Gyro - Sensor");
142	if(BoardRelease == 10)	142	if(BoardRelease == 10)
143	{	143	{
144	LCD_printfxy(0,1,"Pitch %4i (%3i)",AdValueGyrPitch - AdNeutralPitch, AdNeutralPitch);	144	LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick);
145	LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);	145	LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll);
146	LCD_printfxy(0,3,"Yaw %4i (%3i)",Reading_GyroYaw, AdNeutralYaw);	146	LCD_printfxy(0,3,"Yaw %4i (%3i)",Reading_GyroYaw, AdNeutralYaw);
147	}	147	}
148	else	148	else
149	{	149	{
150	LCD_printfxy(0,1,"Pitch %4i (%3i)",AdValueGyrPitch - AdNeutralPitch, AdNeutralPitch/2);	150	LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueGyrNick - AdNeutralNick, AdNeutralNick/2);
151	LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);	151	LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueGyrRoll - AdNeutralRoll, AdNeutralRoll/2);
152	LCD_printfxy(0,3,"Yaw %4i (%3i)",Reading_GyroYaw, AdNeutralYaw/2);	152	LCD_printfxy(0,3,"Yaw %4i (%3i)",Reading_GyroYaw, AdNeutralYaw/2);
153	}	153	}
154	break;	154	break;
155	case 6:// Acceleration Sensor Menu Item	155	case 6:// Acceleration Sensor Menu Item
156	LCD_printfxy(0,0,"ACC - Sensor");	156	LCD_printfxy(0,0,"ACC - Sensor");
157	LCD_printfxy(0,1,"Pitch %4i (%3i)",AdValueAccPitch, NeutralAccX);	157	LCD_printfxy(0,1,"Nick %4i (%3i)",AdValueAccNick, NeutralAccX);
158	LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueAccRoll, NeutralAccY);	158	LCD_printfxy(0,2,"Roll %4i (%3i)",AdValueAccRoll, NeutralAccY);
159	LCD_printfxy(0,3,"Height %4i (%3i)",Mean_AccTop, (int)NeutralAccZ);	159	LCD_printfxy(0,3,"Height %4i (%3i)",Mean_AccTop, (int)NeutralAccZ);
160	break;	160	break;
161	case 7:// Accumulator Voltage / Remote Control Level	161	case 7:// Accumulator Voltage / Remote Control Level
Line 174...	Line 174...
174	LCD_printfxy(0,2,"Po3: %3i Po7: %3i" ,Poti3,Poti7); //PPM24-Extesion	174	LCD_printfxy(0,2,"Po3: %3i Po7: %3i" ,Poti3,Poti7); //PPM24-Extesion
175	LCD_printfxy(0,3,"Po4: %3i Po8: %3i" ,Poti4,Poti8); //PPM24-Extesion	175	LCD_printfxy(0,3,"Po4: %3i Po8: %3i" ,Poti4,Poti8); //PPM24-Extesion
176	break;	176	break;
177	case 10:// Servo Menu Item	177	case 10:// Servo Menu Item
178	LCD_printfxy(0,0,"Servo " );	178	LCD_printfxy(0,0,"Servo " );
179	LCD_printfxy(0,1,"Setpoint %3i",FCParam.ServoPitchControl);	179	LCD_printfxy(0,1,"Setpoint %3i",FCParam.ServoNickControl);
180	LCD_printfxy(0,2,"Position: %3i",ServoValue);	180	LCD_printfxy(0,2,"Position: %3i",ServoValue);
181	LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoPitchMin, ParamSet.ServoPitchMax);	181	LCD_printfxy(0,3,"Range:%3i-%3i",ParamSet.ServoNickMin, ParamSet.ServoNickMax);
182	break;	182	break;
183	case 11://Extern Control	183	case 11://Extern Control
184	LCD_printfxy(0,0,"ExternControl " );	184	LCD_printfxy(0,0,"ExternControl " );
185	LCD_printfxy(0,1,"Pi:%4i Ro:%4i ",ExternControl.Pitch, ExternControl.Roll);	185	LCD_printfxy(0,1,"Ni:%4i Ro:%4i ",ExternControl.Nick, ExternControl.Roll);
186	LCD_printfxy(0,2,"Th:%4i Ya:%4i ",ExternControl.Thrust, ExternControl.Yaw);	186	LCD_printfxy(0,2,"Gs:%4i Ya:%4i ",ExternControl.Gas, ExternControl.Yaw);
187	LCD_printfxy(0,3,"Hi:%4i Cf:%4i ",ExternControl.Height, ExternControl.Config);	187	LCD_printfxy(0,3,"Hi:%4i Cf:%4i ",ExternControl.Height, ExternControl.Config);
188	break;	188	break;
Line 189...	Line 189...
189		189
190	#if defined (USE_KILLAGREG) \|\| defined (USE_MK3MAG)	190	#if defined (USE_KILLAGREG) \|\| defined (USE_MK3MAG)

Subversion Repositories FlightCtrl

(root)/branches/V0.69k CRK HexaLotte/menu.c - Rev 909 → 916