Subversion Repositories FlightCtrl

Rev

Rev 1934 | Rev 1936 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 1934 Rev 1935
Line 165... Line 165...
165
           break;
165
           break;
166
*/
166
*/
167
    case 13:
167
    case 13:
168
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
168
           LCD_printfxy(0,0,"BL-Ctrl Errors " );
169
                   for(i=1;i<4;i++)
169
                   for(i=1;i<4;i++)
-
 
170
                   {
170
                   LCD_printfxy(0,i,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);
171
                    LCD_printfxy(0,i,"%3d %3d %3d %3d ",Motor[i*4].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+1].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+2].State & MOTOR_STATE_ERROR_MASK,Motor[i*4+3].State & MOTOR_STATE_ERROR_MASK);
-
 
172
                        if(i*4 >= RequiredMotors) break;
-
 
173
                   }   
171
           break;
174
           break;
172
    case 14:
175
    case 14:
173
           LCD_printfxy(0,0,"BL Temperature" );
176
           LCD_printfxy(0,0,"BL Temperature" );
174
                   for(i=1;i<4;i++)
177
                   for(i=1;i<4;i++)
-
 
178
                    {
175
                   LCD_printfxy(0,i,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);
179
                     LCD_printfxy(0,i,"%3d %3d %3d %3d ",Motor[i*4].Temperature,Motor[i*4+1].Temperature,Motor[i*4+2].Temperature,Motor[i*4+3].Temperature);
-
 
180
                         if(i*4 >= RequiredMotors) break;
-
 
181
                        }                      
176
           break;
182
           break;
177
    case 15:
183
    case 15:
178
           LCD_printfxy(0,0,"BL-Ctrl found " );
184
           LCD_printfxy(0,0,"BL-Ctrl found " );
179
                   LCD_printfxy(0,1," %c   %c   %c   %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));
185
                   LCD_printfxy(0,1," %c   %c   %c   %c ",'-' + 4 * (Motor[0].State>>7),'-' + 5 * (Motor[1].State>>7),'-' + 6 * (Motor[2].State>>7),'-' + 7 * (Motor[3].State>>7));
180
                   LCD_printfxy(0,2," %c   %c   %c   %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));
186
                   LCD_printfxy(0,2," %c   %c   %c   %c ",'-' + 8 * (Motor[4].State>>7),'-' + 9 * (Motor[5].State>>7),'-' + 10 * (Motor[6].State>>7),'-' + 11 * (Motor[7].State>>7));