diff options
Diffstat (limited to 'firmware/drivers/lcd-recorder.c')
| -rw-r--r-- | firmware/drivers/lcd-recorder.c | 41 |
1 files changed, 24 insertions, 17 deletions
diff --git a/firmware/drivers/lcd-recorder.c b/firmware/drivers/lcd-recorder.c index 00b4ed78b2..597c7d246a 100644 --- a/firmware/drivers/lcd-recorder.c +++ b/firmware/drivers/lcd-recorder.c @@ -29,6 +29,7 @@ #include "debug.h" #include "system.h" #include "font.h" +#include "hwcompat.h" /*** definitions ***/ @@ -113,6 +114,15 @@ static unsigned char zeros[8] = { 0, 0, 0, 0, 0, 0, 0, 0 }; static unsigned char ones[8] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff, 0xff}; +int lcd_default_contrast(void) +{ +#ifdef SIMULATOR + return 30; +#else + return (read_hw_mask() & LCD_CONTRAST_BIAS) ? 31 : 49; +#endif +} + #ifdef SIMULATOR void lcd_init(void) @@ -132,23 +142,20 @@ void lcd_init (void) PBCR2 &= 0xff00; /* MD = 00 */ PBIOR |= 0x000f; /* IOR = 1 */ - /* inits like the original firmware */ - lcd_write(true, LCD_SOFTWARE_RESET); - lcd_write(true, LCD_SET_INTERNAL_REGULATOR_RESISTOR_RATIO + 4); - lcd_write(true, LCD_SET_1OVER4_BIAS_RATIO + 0); /* force 1/4 bias: 0 */ - lcd_write(true, LCD_SET_POWER_CONTROL_REGISTER + 7); /* power control register: op-amp=1, regulator=1, booster=1 */ - lcd_write(true, LCD_SET_DISPLAY_ON); - lcd_write(true, LCD_SET_NORMAL_DISPLAY); - lcd_write(true, LCD_SET_SEGMENT_REMAP + 1); /* mirror horizontal: 1 */ - lcd_write(true, LCD_SET_COM_OUTPUT_SCAN_DIRECTION + 8); /* mirror vertical: 1 */ - lcd_write(true, LCD_SET_DISPLAY_START_LINE + 0); -#if 0 /* done later, depending on h/w mask bit and settings */ - lcd_write(true, LCD_SET_CONTRAST_CONTROL_REGISTER); - lcd_write(true, 0xF1); /* contrast set to 49/64 */ -#endif - lcd_write(true, LCD_SET_PAGE_ADDRESS); - lcd_write(true, LCD_SET_LOWER_COLUMN_ADDRESS + 0); - lcd_write(true, LCD_SET_HIGHER_COLUMN_ADDRESS + 0); + /* inits like the original firmware */ + lcd_write(true, LCD_SOFTWARE_RESET); + lcd_write(true, LCD_SET_INTERNAL_REGULATOR_RESISTOR_RATIO + 4); + lcd_write(true, LCD_SET_1OVER4_BIAS_RATIO + 0); /* force 1/4 bias: 0 */ + lcd_write(true, LCD_SET_POWER_CONTROL_REGISTER + 7); /* power control register: op-amp=1, regulator=1, booster=1 */ + lcd_write(true, LCD_SET_DISPLAY_ON); + lcd_write(true, LCD_SET_NORMAL_DISPLAY); + lcd_write(true, LCD_SET_SEGMENT_REMAP + 1); /* mirror horizontal: 1 */ + lcd_write(true, LCD_SET_COM_OUTPUT_SCAN_DIRECTION + 8); /* mirror vertical: 1 */ + lcd_write(true, LCD_SET_DISPLAY_START_LINE + 0); + lcd_set_contrast(lcd_default_contrast()); + lcd_write(true, LCD_SET_PAGE_ADDRESS); + lcd_write(true, LCD_SET_LOWER_COLUMN_ADDRESS + 0); + lcd_write(true, LCD_SET_HIGHER_COLUMN_ADDRESS + 0); lcd_clear_display(); lcd_update(); |