From 084aa9c1fd670d2250123d0bae42c42ad2570309 Mon Sep 17 00:00:00 2001 From: William Wilgus Date: Sun, 29 Jul 2018 05:10:22 +0200 Subject: Sansa ClipZip set lcd SSP properly Change-Id: Ice62dfa7f266ee4369793777a39e675bceae1831 --- firmware/target/arm/as3525/sansa-clipzip/lcd-clipzip.c | 17 ++++++++++++++++- 1 file changed, 16 insertions(+), 1 deletion(-) diff --git a/firmware/target/arm/as3525/sansa-clipzip/lcd-clipzip.c b/firmware/target/arm/as3525/sansa-clipzip/lcd-clipzip.c index e17bfc421b..03ed1de5d5 100644 --- a/firmware/target/arm/as3525/sansa-clipzip/lcd-clipzip.c +++ b/firmware/target/arm/as3525/sansa-clipzip/lcd-clipzip.c @@ -35,12 +35,26 @@ static int lcd_type; static bool lcd_enabled; #endif +static void ssp_set_prescaler(unsigned int prescaler) +{ + int oldlevel = disable_interrupt_save(IRQ_FIQ_STATUS); + /* must be on to write regs */ + bool ssp_enabled = bitset32(&CGU_PERI, CGU_SSP_CLOCK_ENABLE) & + CGU_SSP_CLOCK_ENABLE; + SSP_CPSR = prescaler; + + if (!ssp_enabled) /* put it back how we found it */ + bitclr32(&CGU_PERI, CGU_SSP_CLOCK_ENABLE); + + restore_irq(oldlevel); +} + /* initialises the host lcd hardware, returns the lcd type */ static int lcd_hw_init(void) { /* configure SSP */ bitset32(&CGU_PERI, CGU_SSP_CLOCK_ENABLE); - SSP_CPSR = 4; /* TODO: use AS3525_SSP_PRESCALER, OF uses 8 */ + ssp_set_prescaler(AS3525_SSP_PRESCALER); /* OF = 0x8 */ SSP_CR0 = (0 << 8) | /* SCR, serial clock rate divider = 1 */ (1 << 7) | /* SPH, phase = 1 */ (1 << 6) | /* SPO, polarity = 1 */ @@ -437,3 +451,4 @@ void lcd_update(void) { lcd_update_rect(0, 0, LCD_WIDTH, LCD_HEIGHT); } + -- cgit v1.2.3