forked from len0rd/rockbox
H300: Optimised PCF50606 driver, significantly reduces CPU power drain from the button tick (with both main & remote buttons: 50%->13% at 11MHz, 12%->6% at 45MHz): * Delay is adapted to the current CPU clock, aiming at constant 400kHz i2c clock. * Reduced number of port accesses (accessing GPIO is very slow, especially with the atomic boolean instructions) by implementing an open-collector-like behaviour. * Time-critical functions implemented in assembler.
git-svn-id: svn://svn.rockbox.org/rockbox/trunk@9693 a1c6a512-1295-4272-9138-f99709370657
This commit is contained in:
Jens Arnold
parent
295c226ed5
commit
f2897e8180
3 changed files with 344 additions and 83 deletions
|
|
@ -27,119 +27,369 @@
|
||||||
|
|
||||||
/* TODO: merge all bit-banged I2C into a generic I2C driver */
|
/* TODO: merge all bit-banged I2C into a generic I2C driver */
|
||||||
|
|
||||||
|
#define USE_ASM
|
||||||
|
|
||||||
#define SDA_LO and_l(~0x00002000, &GPIO1_OUT)
|
|
||||||
#define SDA_HI or_l( 0x00002000, &GPIO1_OUT)
|
|
||||||
#define SDA_INPUT and_l(~0x00002000, &GPIO1_ENABLE)
|
|
||||||
#define SDA_OUTPUT or_l( 0x00002000, &GPIO1_ENABLE)
|
|
||||||
#define SDA ( 0x00002000 & GPIO1_READ)
|
#define SDA ( 0x00002000 & GPIO1_READ)
|
||||||
|
#define SDA_LO_OUT or_l( 0x00002000, &GPIO1_ENABLE)
|
||||||
|
#define SDA_HI_IN and_l(~0x00002000, &GPIO1_ENABLE)
|
||||||
|
|
||||||
/* SCL is GPIO, 3 */
|
|
||||||
#define SCL_INPUT and_l(~0x00001000, &GPIO_ENABLE)
|
|
||||||
#define SCL_OUTPUT or_l( 0x00001000, &GPIO_ENABLE)
|
|
||||||
#define SCL_LO and_l(~0x00001000, &GPIO_OUT)
|
|
||||||
#define SCL_HI SCL_INPUT;while(!SCL){};or_l(0x1000, &GPIO_OUT);SCL_OUTPUT
|
|
||||||
#define SCL ( 0x00001000 & GPIO_READ)
|
#define SCL ( 0x00001000 & GPIO_READ)
|
||||||
|
#define SCL_LO_OUT or_l( 0x00001000, &GPIO_ENABLE)
|
||||||
|
#define SCL_HI_IN and_l(~0x00001000, &GPIO_ENABLE); while(!SCL);
|
||||||
|
|
||||||
/* delay loop to achieve 400kHz at 120MHz CPU frequency */
|
#define DELAY \
|
||||||
#define DELAY do { int _x; for(_x=0;_x<22;_x++);} while(0)
|
asm ( \
|
||||||
|
"move.l %[dly],%%d0 \n" \
|
||||||
|
"1: \n" \
|
||||||
|
"subq.l #1,%%d0 \n" \
|
||||||
|
"bhi.s 1b \n" \
|
||||||
|
: : [dly]"d"(i2c_delay) : "d0" );
|
||||||
|
|
||||||
static void pcf50606_i2c_start(void)
|
static int i2c_delay IDATA_ATTR = 44;
|
||||||
|
|
||||||
|
void pcf50606_i2c_recalc_delay(int cpu_clock)
|
||||||
{
|
{
|
||||||
SDA_OUTPUT;
|
i2c_delay = MAX(cpu_clock / (400000*2*3) - 7, 1);
|
||||||
SCL_OUTPUT;
|
|
||||||
SDA_HI;
|
|
||||||
SCL_HI;
|
|
||||||
DELAY;
|
|
||||||
SDA_LO;
|
|
||||||
DELAY;
|
|
||||||
SCL_LO;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static void pcf50606_i2c_stop(void)
|
static inline void pcf50606_i2c_start(void)
|
||||||
{
|
{
|
||||||
SDA_LO;
|
#ifdef USE_ASM
|
||||||
SCL_HI;
|
asm (
|
||||||
|
"not.l %[sdab] \n" /* SDA_HI_IN */
|
||||||
|
"and.l %[sdab],(8,%[gpi1]) \n"
|
||||||
|
"not.l %[sdab] \n"
|
||||||
|
|
||||||
|
"not.l %[sclb] \n" /* SCL_HI_IN */
|
||||||
|
"and.l %[sclb],(8,%[gpio]) \n"
|
||||||
|
"not.l %[sclb] \n"
|
||||||
|
"1: \n"
|
||||||
|
"move.l (%[gpio]),%%d0 \n"
|
||||||
|
"btst.l #12,%%d0 \n"
|
||||||
|
"beq.s 1b \n"
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"or.l %[sdab],(8,%[gpi1]) \n" /* SDA_LO_OUT */
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"or.l %[sclb],(8,%[gpio]) \n" /* SCL_LO_OUT */
|
||||||
|
: /* outputs */
|
||||||
|
: /* inputs */
|
||||||
|
[gpio]"a"(&GPIO_READ),
|
||||||
|
[sclb]"d"(0x00001000),
|
||||||
|
[gpi1]"a"(&GPIO1_READ),
|
||||||
|
[sdab]"d"(0x00002000),
|
||||||
|
[dly] "d"(i2c_delay)
|
||||||
|
: /* clobbers */
|
||||||
|
"d0"
|
||||||
|
);
|
||||||
|
#else
|
||||||
|
SDA_HI_IN;
|
||||||
|
SCL_HI_IN;
|
||||||
DELAY;
|
DELAY;
|
||||||
SDA_HI;
|
SDA_LO_OUT;
|
||||||
|
DELAY;
|
||||||
|
SCL_LO_OUT;
|
||||||
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static inline void pcf50606_i2c_stop(void)
|
||||||
static void pcf50606_i2c_ack(bool ack)
|
|
||||||
{
|
{
|
||||||
SCL_LO; /* Set the clock low */
|
#ifdef USE_ASM
|
||||||
|
asm (
|
||||||
|
"or.l %[sdab],(8,%[gpi1]) \n" /* SDA_LO_OUT */
|
||||||
|
|
||||||
|
"not.l %[sclb] \n" /* SCL_HI_IN */
|
||||||
|
"and.l %[sclb],(8,%[gpio]) \n"
|
||||||
|
"not.l %[sclb] \n"
|
||||||
|
"1: \n"
|
||||||
|
"move.l (%[gpio]),%%d0 \n"
|
||||||
|
"btst.l #12,%%d0 \n"
|
||||||
|
"beq.s 1b \n"
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"not.l %[sdab] \n" /* SDA_HI_IN */
|
||||||
|
"and.l %[sdab],(8,%[gpi1]) \n"
|
||||||
|
"not.l %[sdab] \n"
|
||||||
|
: /* outputs */
|
||||||
|
: /* inputs */
|
||||||
|
[gpio]"a"(&GPIO_READ),
|
||||||
|
[sclb]"d"(0x00001000),
|
||||||
|
[gpi1]"a"(&GPIO1_READ),
|
||||||
|
[sdab]"d"(0x00002000),
|
||||||
|
[dly] "d"(i2c_delay)
|
||||||
|
: /* clobbers */
|
||||||
|
"d0"
|
||||||
|
);
|
||||||
|
#else
|
||||||
|
SDA_LO_OUT;
|
||||||
|
SCL_HI_IN;
|
||||||
|
DELAY;
|
||||||
|
SDA_HI_IN;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
|
||||||
|
static inline void pcf50606_i2c_ack(bool ack)
|
||||||
|
{
|
||||||
|
#ifdef USE_ASM
|
||||||
|
asm (
|
||||||
|
"tst.b %[ack] \n" /* if (!ack) */
|
||||||
|
"bne.s 1f \n"
|
||||||
|
|
||||||
|
"not.l %[sdab] \n" /* SDA_HI_IN */
|
||||||
|
"and.l %[sdab],(8,%[gpi1]) \n"
|
||||||
|
"not.l %[sdab] \n"
|
||||||
|
".word 0x51fb \n" /* trapf.l : else */
|
||||||
|
"1: \n"
|
||||||
|
"or.l %[sdab],(8,%[gpi1]) \n" /* SDA_LO_OUT */
|
||||||
|
|
||||||
|
"not.l %[sclb] \n" /* SCL_HI_IN */
|
||||||
|
"and.l %[sclb],(8,%[gpio]) \n"
|
||||||
|
"not.l %[sclb] \n"
|
||||||
|
"1: \n"
|
||||||
|
"move.l (%[gpio]),%%d0 \n"
|
||||||
|
"btst.l #12,%%d0 \n"
|
||||||
|
"beq.s 1b \n"
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"or.l %[sclb],(8,%[gpio]) \n" /* SCL_LO_OUT */
|
||||||
|
: /* outputs */
|
||||||
|
: /* inputs */
|
||||||
|
[gpio]"a"(&GPIO_READ),
|
||||||
|
[sclb]"d"(0x00001000),
|
||||||
|
[gpi1]"a"(&GPIO1_READ),
|
||||||
|
[sdab]"d"(0x00002000),
|
||||||
|
[dly] "d"(i2c_delay),
|
||||||
|
[ack] "d"(ack)
|
||||||
|
: /* clobbers */
|
||||||
|
"d0"
|
||||||
|
);
|
||||||
|
#else
|
||||||
if(ack)
|
if(ack)
|
||||||
SDA_LO;
|
SDA_LO_OUT;
|
||||||
else
|
else
|
||||||
SDA_HI;
|
SDA_HI_IN;
|
||||||
|
|
||||||
SCL_HI;
|
SCL_HI_IN;
|
||||||
|
|
||||||
DELAY;
|
DELAY;
|
||||||
SCL_OUTPUT;
|
SCL_LO_OUT;
|
||||||
SCL_LO;
|
#endif
|
||||||
}
|
}
|
||||||
|
|
||||||
static int pcf50606_i2c_getack(void)
|
static inline bool pcf50606_i2c_getack(void)
|
||||||
{
|
{
|
||||||
int ret = 1;
|
bool ret;
|
||||||
|
|
||||||
SDA_INPUT; /* And set to input */
|
#ifdef USE_ASM
|
||||||
|
asm (
|
||||||
|
"not.l %[sdab] \n" /* SDA_HI_IN */
|
||||||
|
"and.l %[sdab],(8,%[gpi1]) \n"
|
||||||
|
"not.l %[sdab] \n"
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"not.l %[sclb] \n" /* SCL_HI_IN */
|
||||||
|
"and.l %[sclb],(8,%[gpio]) \n"
|
||||||
|
"not.l %[sclb] \n"
|
||||||
|
"1: \n"
|
||||||
|
"move.l (%[gpio]),%%d0 \n"
|
||||||
|
"btst.l #12,%%d0 \n"
|
||||||
|
"beq.s 1b \n"
|
||||||
|
|
||||||
|
"move.l (%[gpi1]),%%d0 \n" /* ret = !SDA */
|
||||||
|
"btst.l #13,%%d0 \n"
|
||||||
|
"seq.b %[ret] \n"
|
||||||
|
|
||||||
|
"or.l %[sclb],(8,%[gpio]) \n" /* SCL_LO_OUT */
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
: /* outputs */
|
||||||
|
[ret]"=&r"(ret)
|
||||||
|
: /* inputs */
|
||||||
|
[gpio]"a"(&GPIO_READ),
|
||||||
|
[sclb]"d"(0x00001000),
|
||||||
|
[gpi1]"a"(&GPIO1_READ),
|
||||||
|
[sdab]"d"(0x00002000),
|
||||||
|
[dly] "d"(i2c_delay)
|
||||||
|
: /* clobbers */
|
||||||
|
"d0"
|
||||||
|
);
|
||||||
|
#else
|
||||||
|
SDA_HI_IN;
|
||||||
DELAY;
|
DELAY;
|
||||||
SCL_HI;
|
SCL_HI_IN;
|
||||||
|
|
||||||
if (SDA)
|
ret = !SDA;
|
||||||
/* ack failed */
|
|
||||||
ret = 0;
|
|
||||||
|
|
||||||
SCL_OUTPUT;
|
SCL_LO_OUT;
|
||||||
SCL_LO;
|
|
||||||
SDA_HI;
|
|
||||||
SDA_OUTPUT;
|
|
||||||
DELAY;
|
DELAY;
|
||||||
|
#endif
|
||||||
|
|
||||||
return ret;
|
return ret;
|
||||||
}
|
}
|
||||||
|
|
||||||
static void pcf50606_i2c_outb(unsigned char byte)
|
static void pcf50606_i2c_outb(unsigned char byte)
|
||||||
{
|
{
|
||||||
|
#ifdef USE_ASM
|
||||||
|
asm volatile (
|
||||||
|
"moveq.l #24,%%d0 \n" /* byte <<= 24 */
|
||||||
|
"lsl.l %%d0,%[byte] \n"
|
||||||
|
"moveq.l #8,%%d1 \n" /* i = 8 */
|
||||||
|
|
||||||
|
"2: \n" /* do */
|
||||||
|
"lsl.l #1,%[byte] \n" /* if ((byte <<= 1) carry) */
|
||||||
|
"bcc.s 1f \n"
|
||||||
|
|
||||||
|
"not.l %[sdab] \n" /* SDA_HI_IN */
|
||||||
|
"and.l %[sdab],(8,%[gpi1]) \n"
|
||||||
|
"not.l %[sdab] \n"
|
||||||
|
".word 0x51fb \n" /* trapf.l; else */
|
||||||
|
"1: \n"
|
||||||
|
"or.l %[sdab],(8,%[gpi1]) \n" /* SDA_LO_OUT */
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"not.l %[sclb] \n" /* SCL_HI_IN */
|
||||||
|
"and.l %[sclb],(8,%[gpio]) \n"
|
||||||
|
"not.l %[sclb] \n"
|
||||||
|
"1: \n"
|
||||||
|
"move.l (%[gpio]),%%d0 \n"
|
||||||
|
"btst.l #12,%%d0 \n"
|
||||||
|
"beq.s 1b \n"
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"or.l %[sclb],(8,%[gpio]) \n" /* SCL_LO_OUT */
|
||||||
|
|
||||||
|
"subq.l #1,%%d1 \n" /* i-- */
|
||||||
|
"bne.s 2b \n" /* while (i != 0) */
|
||||||
|
: /* outputs */
|
||||||
|
[byte]"+d"(byte)
|
||||||
|
: /* inputs */
|
||||||
|
[gpio]"a"(&GPIO_READ),
|
||||||
|
[sclb]"d"(0x00001000),
|
||||||
|
[gpi1]"a"(&GPIO1_READ),
|
||||||
|
[sdab]"d"(0x00002000),
|
||||||
|
[dly] "d"(i2c_delay)
|
||||||
|
: /* clobbers */
|
||||||
|
"d0", "d1"
|
||||||
|
);
|
||||||
|
#else
|
||||||
int i;
|
int i;
|
||||||
|
|
||||||
/* clock out each bit, MSB first */
|
/* clock out each bit, MSB first */
|
||||||
for ( i=0x80; i; i>>=1 ) {
|
for ( i=0x80; i; i>>=1 )
|
||||||
|
{
|
||||||
if ( i & byte )
|
if ( i & byte )
|
||||||
{
|
SDA_HI_IN;
|
||||||
SDA_HI;
|
|
||||||
}
|
|
||||||
else
|
else
|
||||||
{
|
SDA_LO_OUT;
|
||||||
SDA_LO;
|
|
||||||
}
|
|
||||||
DELAY;
|
DELAY;
|
||||||
SCL_HI;
|
SCL_HI_IN;
|
||||||
DELAY;
|
DELAY;
|
||||||
SCL_LO;
|
SCL_LO_OUT;
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
SDA_HI;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static unsigned char pcf50606_i2c_inb(bool ack)
|
static unsigned char pcf50606_i2c_inb(bool ack)
|
||||||
{
|
{
|
||||||
int i;
|
|
||||||
unsigned char byte = 0;
|
unsigned char byte = 0;
|
||||||
|
|
||||||
|
#ifdef USE_ASM
|
||||||
|
asm (
|
||||||
|
"not.l %[sdab] \n" /* SDA_HI_IN */
|
||||||
|
"and.l %[sdab],(8,%[gpi1]) \n"
|
||||||
|
"not.l %[sdab] \n"
|
||||||
|
|
||||||
|
"moveq.l #8,%%d1 \n" /* i = 8 */
|
||||||
|
"clr.l %[byte] \n" /* byte = 0 */
|
||||||
|
|
||||||
|
"2: \n" /* do */
|
||||||
|
"not.l %[sclb] \n" /* SCL_HI_IN */
|
||||||
|
"and.l %[sclb],(8,%[gpio]) \n"
|
||||||
|
"not.l %[sclb] \n"
|
||||||
|
"1: \n"
|
||||||
|
"move.l (%[gpio]),%%d0 \n"
|
||||||
|
"btst.l #12,%%d0 \n"
|
||||||
|
"beq.s 1b \n"
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"lsl.l #1,%[byte] \n" /* byte <<= 1 */
|
||||||
|
"move.l (%[gpi1]),%%d0 \n" /* if (SDA) */
|
||||||
|
"btst.l #13,%%d0 \n"
|
||||||
|
"beq.s 1f \n"
|
||||||
|
"addq.l #1,%[byte] \n" /* byte++ */
|
||||||
|
"1: \n"
|
||||||
|
|
||||||
|
"or.l %[sclb],(8,%[gpio]) \n" /* SCL_LO_OUT */
|
||||||
|
|
||||||
|
"move.l %[dly],%%d0 \n" /* DELAY */
|
||||||
|
"1: \n"
|
||||||
|
"subq.l #1,%%d0 \n"
|
||||||
|
"bhi.s 1b \n"
|
||||||
|
|
||||||
|
"subq.l #1,%%d1 \n" /* i-- */
|
||||||
|
"bne.s 2b \n" /* while (i != 0) */
|
||||||
|
: /* outputs */
|
||||||
|
[byte]"=&d"(byte)
|
||||||
|
: /* inputs */
|
||||||
|
[gpio]"a"(&GPIO_READ),
|
||||||
|
[sclb]"d"(0x00001000),
|
||||||
|
[gpi1]"a"(&GPIO1_READ),
|
||||||
|
[sdab]"d"(0x00002000),
|
||||||
|
[dly] "d"(i2c_delay)
|
||||||
|
: /* clobbers */
|
||||||
|
"d0", "d1"
|
||||||
|
);
|
||||||
|
#else
|
||||||
|
int i;
|
||||||
|
|
||||||
/* clock in each bit, MSB first */
|
/* clock in each bit, MSB first */
|
||||||
for ( i=0x80; i; i>>=1 ) {
|
SDA_HI_IN;
|
||||||
SDA_INPUT; /* And set to input */
|
for ( i=0x80; i; i>>=1 )
|
||||||
SCL_HI;
|
{
|
||||||
|
SCL_HI_IN;
|
||||||
DELAY;
|
DELAY;
|
||||||
if ( SDA )
|
if ( SDA )
|
||||||
byte |= i;
|
byte |= i;
|
||||||
SCL_LO;
|
SCL_LO_OUT;
|
||||||
DELAY;
|
DELAY;
|
||||||
SDA_OUTPUT;
|
|
||||||
}
|
}
|
||||||
|
#endif
|
||||||
|
|
||||||
pcf50606_i2c_ack(ack);
|
pcf50606_i2c_ack(ack);
|
||||||
|
|
||||||
|
|
@ -270,12 +520,12 @@ static void set_voltages(void)
|
||||||
void pcf50606_init(void)
|
void pcf50606_init(void)
|
||||||
{
|
{
|
||||||
/* Bit banged I2C */
|
/* Bit banged I2C */
|
||||||
or_l(0x00002000, &GPIO1_OUT);
|
|
||||||
or_l(0x00001000, &GPIO_OUT);
|
|
||||||
or_l(0x00002000, &GPIO1_ENABLE);
|
|
||||||
or_l(0x00001000, &GPIO_ENABLE);
|
|
||||||
or_l(0x00002000, &GPIO1_FUNCTION);
|
or_l(0x00002000, &GPIO1_FUNCTION);
|
||||||
or_l(0x00001000, &GPIO_FUNCTION);
|
or_l(0x00001000, &GPIO_FUNCTION);
|
||||||
|
and_l(~0x00002000, &GPIO1_OUT);
|
||||||
|
and_l(~0x00001000, &GPIO_OUT);
|
||||||
|
and_l(~0x00002000, &GPIO1_ENABLE);
|
||||||
|
and_l(~0x00001000, &GPIO_ENABLE);
|
||||||
|
|
||||||
set_voltages();
|
set_voltages();
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -20,6 +20,7 @@
|
||||||
#define PCF50606_H
|
#define PCF50606_H
|
||||||
|
|
||||||
void pcf50606_init(void);
|
void pcf50606_init(void);
|
||||||
|
void pcf50606_i2c_recalc_delay(int cpu_clock);
|
||||||
int pcf50606_write_multiple(int address, const unsigned char* buf, int count);
|
int pcf50606_write_multiple(int address, const unsigned char* buf, int count);
|
||||||
int pcf50606_write(int address, unsigned char val);
|
int pcf50606_write(int address, unsigned char val);
|
||||||
int pcf50606_read_multiple(int address, unsigned char* buf, int count);
|
int pcf50606_read_multiple(int address, unsigned char* buf, int count);
|
||||||
|
|
|
||||||
|
|
@ -594,6 +594,13 @@ int system_memory_guard(int newmode)
|
||||||
#define DEFAULT_REFRESH_TIMER 1
|
#define DEFAULT_REFRESH_TIMER 1
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
|
#ifdef IRIVER_H300_SERIES
|
||||||
|
#define RECALC_DELAYS(f) \
|
||||||
|
pcf50606_i2c_recalc_delay(f)
|
||||||
|
#else
|
||||||
|
#define RECALC_DELAYS(f)
|
||||||
|
#endif
|
||||||
|
|
||||||
void set_cpu_frequency (long) __attribute__ ((section (".icode")));
|
void set_cpu_frequency (long) __attribute__ ((section (".icode")));
|
||||||
void set_cpu_frequency(long frequency)
|
void set_cpu_frequency(long frequency)
|
||||||
{
|
{
|
||||||
|
|
@ -604,6 +611,7 @@ void set_cpu_frequency(long frequency)
|
||||||
/* Refresh timer for bypass frequency */
|
/* Refresh timer for bypass frequency */
|
||||||
PLLCR &= ~1; /* Bypass mode */
|
PLLCR &= ~1; /* Bypass mode */
|
||||||
timers_adjust_prescale(CPUFREQ_DEFAULT_MULT, false);
|
timers_adjust_prescale(CPUFREQ_DEFAULT_MULT, false);
|
||||||
|
RECALC_DELAYS(CPUFREQ_MAX);
|
||||||
PLLCR = 0x11c56005;
|
PLLCR = 0x11c56005;
|
||||||
CSCR0 = 0x00001180; /* Flash: 4 wait states */
|
CSCR0 = 0x00001180; /* Flash: 4 wait states */
|
||||||
CSCR1 = 0x00000980; /* LCD: 2 wait states */
|
CSCR1 = 0x00000980; /* LCD: 2 wait states */
|
||||||
|
|
@ -621,6 +629,7 @@ void set_cpu_frequency(long frequency)
|
||||||
/* Refresh timer for bypass frequency */
|
/* Refresh timer for bypass frequency */
|
||||||
PLLCR &= ~1; /* Bypass mode */
|
PLLCR &= ~1; /* Bypass mode */
|
||||||
timers_adjust_prescale(CPUFREQ_DEFAULT_MULT, false);
|
timers_adjust_prescale(CPUFREQ_DEFAULT_MULT, false);
|
||||||
|
RECALC_DELAYS(CPUFREQ_NORMAL);
|
||||||
PLLCR = 0x13c5e005;
|
PLLCR = 0x13c5e005;
|
||||||
CSCR0 = 0x00000580; /* Flash: 1 wait state */
|
CSCR0 = 0x00000580; /* Flash: 1 wait state */
|
||||||
CSCR1 = 0x00000180; /* LCD: 0 wait states */
|
CSCR1 = 0x00000180; /* LCD: 0 wait states */
|
||||||
|
|
@ -637,6 +646,7 @@ void set_cpu_frequency(long frequency)
|
||||||
/* Refresh timer for bypass frequency */
|
/* Refresh timer for bypass frequency */
|
||||||
PLLCR &= ~1; /* Bypass mode */
|
PLLCR &= ~1; /* Bypass mode */
|
||||||
timers_adjust_prescale(CPUFREQ_DEFAULT_MULT, true);
|
timers_adjust_prescale(CPUFREQ_DEFAULT_MULT, true);
|
||||||
|
RECALC_DELAYS(CPUFREQ_DEFAULT);
|
||||||
PLLCR = 0x10c00200; /* Power down PLL, but keep CLSEL and CRSEL */
|
PLLCR = 0x10c00200; /* Power down PLL, but keep CLSEL and CRSEL */
|
||||||
CSCR0 = 0x00000180; /* Flash: 0 wait states */
|
CSCR0 = 0x00000180; /* Flash: 0 wait states */
|
||||||
CSCR1 = 0x00000180; /* LCD: 0 wait states */
|
CSCR1 = 0x00000180; /* LCD: 0 wait states */
|
||||||
|
|
|
||||||
Loading…
Add table
Add a link
Reference in a new issue