Sansa Clip+ set lcd SSP properly

Change-Id: I152f038954ac1649b30dd17c3e6332e4d756502c
This commit is contained in:
William Wilgus 2018-07-29 05:08:27 +02:00
parent 084aa9c1fd
commit 6ed38c89ae

View file

@ -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 */