Rev 1934 | Rev 1936 | Go to most recent revision | Show entire file | Regard 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)); |