diff options
| author | William Wilgus <me.theuser@yahoo.com> | 2018-07-29 05:08:27 +0200 |
|---|---|---|
| committer | William Wilgus <me.theuser@yahoo.com> | 2020-05-23 15:03:58 +0200 |
| commit | 6ed38c89aeb1b855fda1e09e999110deeda6ecd8 (patch) | |
| tree | eda852a48c3dd250a3eefea5e5f00382dfd715ad /firmware | |
| parent | 084aa9c1fd670d2250123d0bae42c42ad2570309 (diff) | |
Sansa Clip+ set lcd SSP properly
Change-Id: I152f038954ac1649b30dd17c3e6332e4d756502c
Diffstat (limited to 'firmware')
| -rw-r--r-- | firmware/target/arm/as3525/sansa-clipplus/lcd-clip-plus.c | 16 |
1 files changed, 15 insertions, 1 deletions
diff --git a/firmware/target/arm/as3525/sansa-clipplus/lcd-clip-plus.c b/firmware/target/arm/as3525/sansa-clipplus/lcd-clip-plus.c index a50a9e5c80..42cd43a880 100644 --- a/firmware/target/arm/as3525/sansa-clipplus/lcd-clip-plus.c +++ b/firmware/target/arm/as3525/sansa-clipplus/lcd-clip-plus.c @@ -26,11 +26,25 @@ #include "system.h" #include "cpu.h" +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); +} + int lcd_hw_init(void) { bitset32(&CGU_PERI, CGU_SSP_CLOCK_ENABLE); - SSP_CPSR = AS3525_SSP_PRESCALER; /* OF = 0x10 */ + ssp_set_prescaler(AS3525_SSP_PRESCALER); /* OF = 0x10 */ SSP_CR0 = (1<<7) | (1<<6) | 7; /* Motorola SPI frame format, 8 bits */ SSP_CR1 = (1<<3) | (1<<1); /* SSP Operation enabled */ SSP_IMSC = 0; /* No interrupts */ |