diff options
| -rw-r--r-- | firmware/drivers/serial.c | 54 |
1 files changed, 53 insertions, 1 deletions
diff --git a/firmware/drivers/serial.c b/firmware/drivers/serial.c index 112e45c1e4..91e2a6911f 100644 --- a/firmware/drivers/serial.c +++ b/firmware/drivers/serial.c @@ -27,7 +27,7 @@ #include "lcd.h" #include "serial.h" -/* Recieved byte identifiers */ +/* Received byte identifiers */ #define PLAY 0xC1 #define STOP 0xC2 #define PREV 0xC4 @@ -35,6 +35,12 @@ #define VOLUP 0xD0 #define VOLDN 0xE0 +#ifdef SCREENDUMP +#define SCRDMP 0xF0 + +static void screen_dump(void); +#endif + void serial_setup (void) { char dummy; @@ -86,6 +92,12 @@ static void process_byte(int byte) case NEXT: btn = BUTTON_RIGHT; break; + +#ifdef SCREENDUMP + case SCRDMP: + screen_dump(); + break; +#endif } if ( btn ) { @@ -110,3 +122,43 @@ void RXI1 (void) SSR1 = SSR1 & ~0x40; /* Clear RDRF */ process_byte(serial_byte); } + +#ifdef SCREENDUMP +static void serial_enable_tx(void) +{ + SCR1 |= 0x20; +} + +static void serial_tx(unsigned char ch) +{ + while (!(SSR1 & SCI_TDRE)) + { + ; + } + + /* + * Write data into TDR and clear TDRE + */ + TDR1 = ch; + SSR1 &= ~SCI_TDRE; +} + +static void screen_dump(void) +{ + int x, y; + int level; + + serial_enable_tx(); + + level = set_irq_level(15); + for(y = 0;y < LCD_HEIGHT/8;y++) + { + for(x = 0;x < LCD_WIDTH;x++) + { + serial_tx(lcd_framebuffer[x][y]); + } + } + set_irq_level(level); +} + +#endif |