| /*************************************************************************** |
| * __________ __ ___. |
| * Open \______ \ ____ ____ | | _\_ |__ _______ ___ |
| * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ / |
| * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < < |
| * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \ |
| * \/ \/ \/ \/ \/ |
| * $Id$ |
| * |
| * Copyright (C) 2006 by Linus Nielsen Feltzing |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * as published by the Free Software Foundation; either version 2 |
| * of the License, or (at your option) any later version. |
| * |
| * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY |
| * KIND, either express or implied. |
| * |
| ****************************************************************************/ |
| #include "config.h" |
| #include "system.h" |
| #include "logf.h" |
| #include "kernel.h" |
| #include "pcf50606.h" |
| |
| #define USE_ASM |
| |
| /* Define the approprate bits for SDA and SCL being the only difference in |
| config between each player. */ |
| #if defined(IRIVER_H300_SERIES) |
| #define SDA_BITNUM 13 /* LRCK3/GPIO45 */ |
| #define SCL_BITNUM 12 /* SWE/GPIO12 */ |
| #elif defined(IAUDIO_X5) || defined(IAUDIO_M5) |
| #define SDA_BITNUM 12 /* SDA1/RXD1/GPIO44 */ |
| #define SCL_BITNUM 10 /* SCL1/TXD1/GPIO10 */ |
| #endif |
| |
| /* Data */ |
| #define SDA_GPIO_READ GPIO1_READ /* MBAR2 + 0x0b0 */ |
| #define SDA_GPIO_OUT GPIO1_OUT /* MBAR2 + 0x0b4 */ |
| #define SDA_GPIO_ENABLE GPIO1_ENABLE /* MBAR2 + 0x0b8 */ |
| #define SDA_GPIO_FUNCTION GPIO1_FUNCTION /* MBAR2 + 0x0bc */ |
| |
| /* Clock */ |
| #define SCL_GPIO_READ GPIO_READ /* MBAR2 + 0x000 */ |
| #define SCL_GPIO_OUT GPIO_OUT /* MBAR2 + 0x004 */ |
| #define SCL_GPIO_ENABLE GPIO_ENABLE /* MBAR2 + 0x008 */ |
| #define SCL_GPIO_FUNCTION GPIO_FUNCTION /* MBAR2 + 0x00c */ |
| |
| #define PCF50606_ADDR 0x10 |
| #define SCL_BIT (1ul << SCL_BITNUM) |
| #define SDA_BIT (1ul << SDA_BITNUM) |
| |
| #define SDA ( SDA_BIT & SDA_GPIO_READ) |
| #define SDA_LO_OUT or_l( SDA_BIT, &SDA_GPIO_ENABLE) |
| #define SDA_HI_IN and_l(~SDA_BIT, &SDA_GPIO_ENABLE) |
| |
| #define SCL ( SCL_BIT & SCL_GPIO_READ) |
| #define SCL_LO_OUT or_l( SCL_BIT, &SCL_GPIO_ENABLE) |
| #define SCL_HI_IN and_l(~SCL_BIT, &SCL_GPIO_ENABLE); while(!SCL); |
| |
| #define DELAY \ |
| asm ( \ |
| "move.l %[dly],%%d0 \n" \ |
| "1: \n" \ |
| "subq.l #1,%%d0 \n" \ |
| "bhi.s 1b \n" \ |
| : : [dly]"d"(i2c_delay) : "d0" ); |
| |
| void pcf50606_i2c_init(void) |
| { |
| /* Bit banged I2C */ |
| or_l(SDA_BIT, &SDA_GPIO_FUNCTION); |
| or_l(SCL_BIT, &SCL_GPIO_FUNCTION); |
| and_l(~SDA_BIT, &SDA_GPIO_OUT); |
| and_l(~SCL_BIT, &SCL_GPIO_OUT); |
| and_l(~SDA_BIT, &SDA_GPIO_ENABLE); |
| and_l(~SCL_BIT, &SCL_GPIO_ENABLE); |
| } |
| |
| static int i2c_delay IDATA_ATTR = 44; |
| |
| void pcf50606_i2c_recalc_delay(int cpu_clock) |
| { |
| i2c_delay = MAX(cpu_clock / (400000*2*3) - 7, 1); |
| } |
| |
| inline void pcf50606_i2c_start(void) |
| { |
| #ifdef USE_ASM |
| asm ( |
| "not.l %[sdab] \n" /* SDA_HI_IN */ |
| "and.l %[sdab],(8,%[sdard]) \n" |
| "not.l %[sdab] \n" |
| |
| "not.l %[sclb] \n" /* SCL_HI_IN */ |
| "and.l %[sclb],(8,%[sclrd]) \n" |
| "not.l %[sclb] \n" |
| "1: \n" |
| "move.l (%[sclrd]),%%d0 \n" |
| "btst.l %[sclbnum], %%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,%[sdard]) \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,%[sclrd]) \n" /* SCL_LO_OUT */ |
| : /* outputs */ |
| : /* inputs */ |
| [sclrd] "a"(&SCL_GPIO_READ), |
| [sclb] "d"(SCL_BIT), |
| [sclbnum] "i"(SCL_BITNUM), |
| [sdard] "a"(&SDA_GPIO_READ), |
| [sdab] "d"(SDA_BIT), |
| [dly] "d"(i2c_delay) |
| : /* clobbers */ |
| "d0" |
| ); |
| #else |
| SDA_HI_IN; |
| SCL_HI_IN; |
| DELAY; |
| SDA_LO_OUT; |
| DELAY; |
| SCL_LO_OUT; |
| #endif |
| } |
| |
| inline void pcf50606_i2c_stop(void) |
| { |
| #ifdef USE_ASM |
| asm ( |
| "or.l %[sdab],(8,%[sdard]) \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,%[sclrd]) \n" |
| "not.l %[sclb] \n" |
| "1: \n" |
| "move.l (%[sclrd]),%%d0 \n" |
| "btst.l %[sclbnum],%%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,%[sdard]) \n" |
| "not.l %[sdab] \n" |
| : /* outputs */ |
| : /* inputs */ |
| [sclrd] "a"(&SCL_GPIO_READ), |
| [sclb] "d"(SCL_BIT), |
| [sclbnum] "i"(SCL_BITNUM), |
| [sdard] "a"(&SDA_GPIO_READ), |
| [sdab] "d"(SDA_BIT), |
| [dly] "d"(i2c_delay) |
| : /* clobbers */ |
| "d0" |
| ); |
| #else |
| SDA_LO_OUT; |
| DELAY; |
| SCL_HI_IN; |
| DELAY; |
| SDA_HI_IN; |
| #endif |
| } |
| |
| 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,%[sdard]) \n" |
| "not.l %[sdab] \n" |
| ".word 0x51fb \n" /* trapf.l : else */ |
| "1: \n" |
| "or.l %[sdab],(8,%[sdard]) \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,%[sclrd]) \n" |
| "not.l %[sclb] \n" |
| "1: \n" |
| "move.l (%[sclrd]),%%d0 \n" |
| "btst.l %[sclbnum],%%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,%[sclrd]) \n" /* SCL_LO_OUT */ |
| : /* outputs */ |
| : /* inputs */ |
| [sclrd] "a"(&SCL_GPIO_READ), |
| [sclb] "d"(SCL_BIT), |
| [sclbnum] "i"(SCL_BITNUM), |
| [sdard] "a"(&SDA_GPIO_READ), |
| [sdab] "d"(SDA_BIT), |
| [dly] "d"(i2c_delay), |
| [ack] "d"(ack) |
| : /* clobbers */ |
| "d0" |
| ); |
| #else |
| if(ack) |
| SDA_LO_OUT; |
| else |
| SDA_HI_IN; |
| DELAY; |
| SCL_HI_IN; |
| DELAY; |
| SCL_LO_OUT; |
| #endif |
| } |
| |
| inline bool pcf50606_i2c_getack(void) |
| { |
| bool ret; |
| |
| #ifdef USE_ASM |
| asm ( |
| "not.l %[sdab] \n" /* SDA_HI_IN */ |
| "and.l %[sdab],(8,%[sdard]) \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,%[sclrd]) \n" |
| "not.l %[sclb] \n" |
| "1: \n" |
| "move.l (%[sclrd]),%%d0 \n" |
| "btst.l %[sclbnum],%%d0 \n" |
| "beq.s 1b \n" |
| |
| "move.l %[dly],%%d0 \n" /* DELAY */ |
| "1: \n" |
| "subq.l #1,%%d0 \n" |
| "bhi.s 1b \n" |
| |
| "move.l (%[sdard]),%%d0 \n" /* ret = !SDA */ |
| "btst.l %[sdabnum],%%d0 \n" |
| "seq.b %[ret] \n" |
| |
| "or.l %[sclb],(8,%[sclrd]) \n" /* SCL_LO_OUT */ |
| : /* outputs */ |
| [ret] "=&d"(ret) |
| : /* inputs */ |
| [sclrd] "a"(&SCL_GPIO_READ), |
| [sclb] "d"(SCL_BIT), |
| [sclbnum] "i"(SCL_BITNUM), |
| [sdard] "a"(&SDA_GPIO_READ), |
| [sdab] "d"(SDA_BIT), |
| [sdabnum] "i"(SDA_BITNUM), |
| [dly] "d"(i2c_delay) |
| : /* clobbers */ |
| "d0" |
| ); |
| #else |
| SDA_HI_IN; |
| DELAY; |
| SCL_HI_IN; |
| DELAY; |
| |
| ret = !SDA; |
| |
| SCL_LO_OUT; |
| #endif |
| return ret; |
| } |
| |
| 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,%[sdard]) \n" |
| "not.l %[sdab] \n" |
| ".word 0x51fb \n" /* trapf.l; else */ |
| "1: \n" |
| "or.l %[sdab],(8,%[sdard]) \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,%[sclrd]) \n" |
| "not.l %[sclb] \n" |
| "1: \n" |
| "move.l (%[sclrd]),%%d0 \n" |
| "btst.l %[sclbnum],%%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,%[sclrd]) \n" /* SCL_LO_OUT */ |
| |
| "subq.l #1,%%d1 \n" /* i-- */ |
| "bne.s 2b \n" /* while (i != 0) */ |
| : /* outputs */ |
| [byte] "+d"(byte) |
| : /* inputs */ |
| [sclrd] "a"(&SCL_GPIO_READ), |
| [sclb] "d"(SCL_BIT), |
| [sclbnum] "i"(SCL_BITNUM), |
| [sdard] "a"(&SDA_GPIO_READ), |
| [sdab] "d"(SDA_BIT), |
| [dly] "d"(i2c_delay) |
| : /* clobbers */ |
| "d0", "d1" |
| ); |
| #else |
| int i; |
| |
| /* clock out each bit, MSB first */ |
| for ( i=0x80; i; i>>=1 ) |
| { |
| if ( i & byte ) |
| SDA_HI_IN; |
| else |
| SDA_LO_OUT; |
| DELAY; |
| SCL_HI_IN; |
| DELAY; |
| SCL_LO_OUT; |
| } |
| #endif |
| } |
| |
| unsigned char pcf50606_i2c_inb(bool ack) |
| { |
| unsigned char byte = 0; |
| |
| #ifdef USE_ASM |
| asm ( |
| "not.l %[sdab] \n" /* SDA_HI_IN */ |
| "and.l %[sdab],(8,%[sdard]) \n" |
| "not.l %[sdab] \n" |
| |
| "moveq.l #8,%%d1 \n" /* i = 8 */ |
| "clr.l %[byte] \n" /* byte = 0 */ |
| |
| "2: \n" /* do */ |
| "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,%[sclrd]) \n" |
| "not.l %[sclb] \n" |
| "1: \n" |
| "move.l (%[sclrd]),%%d0 \n" |
| "btst.l %[sclbnum],%%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 (%[sdard]),%%d0 \n" /* if (SDA) */ |
| "btst.l %[sdabnum],%%d0 \n" |
| "beq.s 1f \n" |
| "addq.l #1,%[byte] \n" /* byte++ */ |
| "1: \n" |
| |
| "or.l %[sclb],(8,%[sclrd]) \n" /* SCL_LO_OUT */ |
| |
| "subq.l #1,%%d1 \n" /* i-- */ |
| "bne.s 2b \n" /* while (i != 0) */ |
| : /* outputs */ |
| [byte] "=&d"(byte) |
| : /* inputs */ |
| [sclrd] "a"(&SCL_GPIO_READ), |
| [sclb] "d"(SCL_BIT), |
| [sclbnum] "i"(SCL_BITNUM), |
| [sdard] "a"(&SDA_GPIO_READ), |
| [sdab] "d"(SDA_BIT), |
| [sdabnum] "i"(SDA_BITNUM), |
| [dly] "d"(i2c_delay) |
| : /* clobbers */ |
| "d0", "d1" |
| ); |
| #else |
| int i; |
| |
| /* clock in each bit, MSB first */ |
| SDA_HI_IN; |
| for ( i=0x80; i; i>>=1 ) |
| { |
| DELAY; |
| SCL_HI_IN; |
| DELAY; |
| if ( SDA ) |
| byte |= i; |
| SCL_LO_OUT; |
| } |
| #endif |
| |
| pcf50606_i2c_ack(ack); |
| |
| return byte; |
| } |
| |
| int pcf50606_i2c_write(int address, const unsigned char* buf, int count) |
| { |
| int i,x=0; |
| |
| pcf50606_i2c_start(); |
| pcf50606_i2c_outb(address & 0xfe); |
| if (pcf50606_i2c_getack()) |
| { |
| for (i=0; i<count; i++) |
| { |
| pcf50606_i2c_outb(buf[i]); |
| if (!pcf50606_i2c_getack()) |
| { |
| x=-2; |
| break; |
| } |
| } |
| } |
| else |
| { |
| logf("pcf50606_i2c_write() - no ack\n"); |
| x=-1; |
| } |
| return x; |
| } |
| |
| int pcf50606_read_multiple(int address, unsigned char* buf, int count) |
| { |
| int i=0; |
| int ret = 0; |
| unsigned char obuf[1]; |
| |
| obuf[0] = address; |
| |
| /* send read command */ |
| if (pcf50606_i2c_write(PCF50606_ADDR, obuf, 1) >= 0) |
| { |
| pcf50606_i2c_start(); |
| pcf50606_i2c_outb(0x11); |
| if (pcf50606_i2c_getack()) |
| { |
| for(i = 0;i < count-1;i++) |
| buf[i] = pcf50606_i2c_inb(true); |
| |
| buf[i] = pcf50606_i2c_inb(false); |
| } |
| else |
| { |
| ret = -1; |
| } |
| } |
| |
| pcf50606_i2c_stop(); |
| |
| return ret; |
| } |
| |
| int pcf50606_read(int address) |
| { |
| int ret; |
| unsigned char c; |
| |
| ret = pcf50606_read_multiple(address, &c, 1); |
| if(ret >= 0) |
| return c; |
| else |
| return ret; |
| } |
| |
| int pcf50606_write_multiple(int address, const unsigned char* buf, int count) |
| { |
| unsigned char obuf[1]; |
| int i; |
| int ret = 0; |
| |
| obuf[0] = address; |
| |
| /* send write command */ |
| if (pcf50606_i2c_write(PCF50606_ADDR, obuf, 1) >= 0) |
| { |
| for (i=0; i<count; i++) |
| { |
| pcf50606_i2c_outb(buf[i]); |
| if (!pcf50606_i2c_getack()) |
| { |
| ret = -2; |
| break; |
| } |
| } |
| } |
| else |
| { |
| ret = -1; |
| } |
| |
| pcf50606_i2c_stop(); |
| return ret; |
| } |
| |
| int pcf50606_write(int address, unsigned char val) |
| { |
| return pcf50606_write_multiple(address, &val, 1); |
| } |