Skip to content
Snippets Groups Projects
designware_i2c.c 9.4 KiB
Newer Older
  • Learn to ignore specific revisions
  • /*
     * (C) Copyright 2009
     * Vipin Kumar, ST Micoelectronics, vipin.kumar@st.com.
     *
    
     * SPDX-License-Identifier:	GPL-2.0+
    
     */
    
    #include <common.h>
    #include <asm/io.h>
    
    #include "designware_i2c.h"
    
    #ifdef CONFIG_I2C_MULTI_BUS
    static unsigned int bus_initialized[CONFIG_SYS_I2C_BUS_MAX];
    static unsigned int current_bus = 0;
    #endif
    
    static struct i2c_regs *i2c_regs_p =
    
        (struct i2c_regs *)CONFIG_SYS_I2C_BASE;
    
    /*
     * set_speed - Set the i2c speed mode (standard, high, fast)
     * @i2c_spd:	required i2c speed mode
     *
     * Set the i2c speed mode (standard, high, fast)
     */
    static void set_speed(int i2c_spd)
    {
    	unsigned int cntl;
    	unsigned int hcnt, lcnt;
    
    	unsigned int enbl;
    
    	/* to set speed cltr must be disabled */
    	enbl = readl(&i2c_regs_p->ic_enable);
    	enbl &= ~IC_ENABLE_0B;
    	writel(enbl, &i2c_regs_p->ic_enable);
    
    
    	cntl = (readl(&i2c_regs_p->ic_con) & (~IC_CON_SPD_MSK));
    
    	switch (i2c_spd) {
    	case IC_SPEED_MODE_MAX:
    		cntl |= IC_CON_SPD_HS;
    
    		hcnt = (IC_CLK * MIN_HS_SCL_HIGHTIME) / NANO_TO_MICRO;
    		writel(hcnt, &i2c_regs_p->ic_hs_scl_hcnt);
    		lcnt = (IC_CLK * MIN_HS_SCL_LOWTIME) / NANO_TO_MICRO;
    		writel(lcnt, &i2c_regs_p->ic_hs_scl_lcnt);
    
    		break;
    
    	case IC_SPEED_MODE_STANDARD:
    		cntl |= IC_CON_SPD_SS;
    
    		hcnt = (IC_CLK * MIN_SS_SCL_HIGHTIME) / NANO_TO_MICRO;
    		writel(hcnt, &i2c_regs_p->ic_ss_scl_hcnt);
    		lcnt = (IC_CLK * MIN_SS_SCL_LOWTIME) / NANO_TO_MICRO;
    		writel(lcnt, &i2c_regs_p->ic_ss_scl_lcnt);
    
    		break;
    
    	case IC_SPEED_MODE_FAST:
    	default:
    		cntl |= IC_CON_SPD_FS;
    
    		hcnt = (IC_CLK * MIN_FS_SCL_HIGHTIME) / NANO_TO_MICRO;
    		writel(hcnt, &i2c_regs_p->ic_fs_scl_hcnt);
    		lcnt = (IC_CLK * MIN_FS_SCL_LOWTIME) / NANO_TO_MICRO;
    		writel(lcnt, &i2c_regs_p->ic_fs_scl_lcnt);
    
    		break;
    	}
    
    	writel(cntl, &i2c_regs_p->ic_con);
    
    
    	/* Enable back i2c now speed set */
    
    	enbl |= IC_ENABLE_0B;
    	writel(enbl, &i2c_regs_p->ic_enable);
    
    }
    
    /*
     * i2c_set_bus_speed - Set the i2c speed
     * @speed:	required i2c speed
     *
     * Set the i2c speed.
     */
    
    int i2c_set_bus_speed(int speed)
    
    {
    	if (speed >= I2C_MAX_SPEED)
    		set_speed(IC_SPEED_MODE_MAX);
    	else if (speed >= I2C_FAST_SPEED)
    		set_speed(IC_SPEED_MODE_FAST);
    	else
    		set_speed(IC_SPEED_MODE_STANDARD);
    
    }
    
    /*
     * i2c_get_bus_speed - Gets the i2c speed
     *
     * Gets the i2c speed.
     */
    int i2c_get_bus_speed(void)
    {
    	u32 cntl;
    
    	cntl = (readl(&i2c_regs_p->ic_con) & IC_CON_SPD_MSK);
    
    	if (cntl == IC_CON_SPD_HS)
    		return I2C_MAX_SPEED;
    	else if (cntl == IC_CON_SPD_FS)
    		return I2C_FAST_SPEED;
    	else if (cntl == IC_CON_SPD_SS)
    		return I2C_STANDARD_SPEED;
    
    	return 0;
    }
    
    /*
     * i2c_init - Init function
     * @speed:	required i2c speed
    
     * @slaveadd:	slave address for the device
    
     *
     * Initialization function.
     */
    void i2c_init(int speed, int slaveadd)
    {
    	unsigned int enbl;
    
    	/* Disable i2c */
    	enbl = readl(&i2c_regs_p->ic_enable);
    	enbl &= ~IC_ENABLE_0B;
    	writel(enbl, &i2c_regs_p->ic_enable);
    
    	writel((IC_CON_SD | IC_CON_SPD_FS | IC_CON_MM), &i2c_regs_p->ic_con);
    	writel(IC_RX_TL, &i2c_regs_p->ic_rx_tl);
    	writel(IC_TX_TL, &i2c_regs_p->ic_tx_tl);
    	i2c_set_bus_speed(speed);
    	writel(IC_STOP_DET, &i2c_regs_p->ic_intr_mask);
    	writel(slaveadd, &i2c_regs_p->ic_sar);
    
    	/* Enable i2c */
    	enbl = readl(&i2c_regs_p->ic_enable);
    	enbl |= IC_ENABLE_0B;
    	writel(enbl, &i2c_regs_p->ic_enable);
    
    
    #ifdef CONFIG_I2C_MULTI_BUS
    	bus_initialized[current_bus] = 1;
    #endif
    
    }
    
    /*
     * i2c_setaddress - Sets the target slave address
     * @i2c_addr:	target i2c address
     *
     * Sets the target slave address.
     */
    static void i2c_setaddress(unsigned int i2c_addr)
    {
    
    	unsigned int enbl;
    
    	/* Disable i2c */
    	enbl = readl(&i2c_regs_p->ic_enable);
    	enbl &= ~IC_ENABLE_0B;
    	writel(enbl, &i2c_regs_p->ic_enable);
    
    
    	writel(i2c_addr, &i2c_regs_p->ic_tar);
    
    
    	/* Enable i2c */
    	enbl = readl(&i2c_regs_p->ic_enable);
    	enbl |= IC_ENABLE_0B;
    	writel(enbl, &i2c_regs_p->ic_enable);
    
    }
    
    /*
     * i2c_flush_rxfifo - Flushes the i2c RX FIFO
     *
     * Flushes the i2c RX FIFO
     */
    static void i2c_flush_rxfifo(void)
    {
    	while (readl(&i2c_regs_p->ic_status) & IC_STATUS_RFNE)
    		readl(&i2c_regs_p->ic_cmd_data);
    }
    
    /*
     * i2c_wait_for_bb - Waits for bus busy
     *
     * Waits for bus busy
     */
    static int i2c_wait_for_bb(void)
    {
    	unsigned long start_time_bb = get_timer(0);
    
    	while ((readl(&i2c_regs_p->ic_status) & IC_STATUS_MA) ||
    	       !(readl(&i2c_regs_p->ic_status) & IC_STATUS_TFE)) {
    
    		/* Evaluate timeout */
    		if (get_timer(start_time_bb) > (unsigned long)(I2C_BYTE_TO_BB))
    			return 1;
    	}
    
    	return 0;
    }
    
    
    static int i2c_xfer_init(uchar chip, uint addr, int alen)
    
    		return 1;
    
    	i2c_setaddress(chip);
    
    	while (alen) {
    		alen--;
    		/* high byte address going out first */
    		writel((addr >> (alen * 8)) & 0xff,
    		       &i2c_regs_p->ic_cmd_data);
    	}
    
    	return 0;
    }
    
    static int i2c_xfer_finish(void)
    {
    	ulong start_stop_det = get_timer(0);
    
    	while (1) {
    		if ((readl(&i2c_regs_p->ic_raw_intr_stat) & IC_STOP_DET)) {
    			readl(&i2c_regs_p->ic_clr_stop_det);
    			break;
    		} else if (get_timer(start_stop_det) > I2C_STOPDET_TO) {
    			break;
    		}
    	}
    
    	if (i2c_wait_for_bb()) {
    		printf("Timed out waiting for bus\n");
    		return 1;
    	}
    
    	i2c_flush_rxfifo();
    
    	return 0;
    }
    
    /*
     * i2c_read - Read from i2c memory
     * @chip:	target i2c address
     * @addr:	address to read from
     * @alen:
     * @buffer:	buffer for read data
     * @len:	no of bytes to be read
     *
     * Read from i2c memory.
     */
    int i2c_read(uchar chip, uint addr, int alen, uchar *buffer, int len)
    {
    	unsigned long start_time_rx;
    
    
    #ifdef CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW
    	/*
    	 * EEPROM chips that implement "address overflow" are ones
    	 * like Catalyst 24WC04/08/16 which has 9/10/11 bits of
    	 * address and the extra bits end up in the "chip address"
    	 * bit slots. This makes a 24WC08 (1Kbyte) chip look like
    	 * four 256 byte chips.
    	 *
    	 * Note that we consider the length of the address field to
    	 * still be one byte because the extra address bits are
    	 * hidden in the chip address.
    	 */
    	chip |= ((addr >> (alen * 8)) & CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW);
    	addr &= ~(CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW << (alen * 8));
    
    	debug("%s: fix addr_overflow: chip %02x addr %02x\n", __func__, chip,
    	      addr);
    #endif
    
    
    	if (i2c_xfer_init(chip, addr, alen))
    
    		return 1;
    
    	start_time_rx = get_timer(0);
    	while (len) {
    
    		if (len == 1)
    			writel(IC_CMD | IC_STOP, &i2c_regs_p->ic_cmd_data);
    		else
    			writel(IC_CMD, &i2c_regs_p->ic_cmd_data);
    
    
    		if (readl(&i2c_regs_p->ic_status) & IC_STATUS_RFNE) {
    			*buffer++ = (uchar)readl(&i2c_regs_p->ic_cmd_data);
    			len--;
    			start_time_rx = get_timer(0);
    
    		} else if (get_timer(start_time_rx) > I2C_BYTE_TO) {
    				return 1;
    		}
    	}
    
    	return i2c_xfer_finish();
    }
    
    /*
     * i2c_write - Write to i2c memory
     * @chip:	target i2c address
     * @addr:	address to read from
     * @alen:
     * @buffer:	buffer for read data
     * @len:	no of bytes to be read
     *
     * Write to i2c memory.
     */
    int i2c_write(uchar chip, uint addr, int alen, uchar *buffer, int len)
    {
    	int nb = len;
    	unsigned long start_time_tx;
    
    
    #ifdef CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW
    	/*
    	 * EEPROM chips that implement "address overflow" are ones
    	 * like Catalyst 24WC04/08/16 which has 9/10/11 bits of
    	 * address and the extra bits end up in the "chip address"
    	 * bit slots. This makes a 24WC08 (1Kbyte) chip look like
    	 * four 256 byte chips.
    	 *
    	 * Note that we consider the length of the address field to
    	 * still be one byte because the extra address bits are
    	 * hidden in the chip address.
    	 */
    	chip |= ((addr >> (alen * 8)) & CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW);
    	addr &= ~(CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW << (alen * 8));
    
    	debug("%s: fix addr_overflow: chip %02x addr %02x\n", __func__, chip,
    	      addr);
    #endif
    
    
    	if (i2c_xfer_init(chip, addr, alen))
    
    		return 1;
    
    	start_time_tx = get_timer(0);
    	while (len) {
    		if (readl(&i2c_regs_p->ic_status) & IC_STATUS_TFNF) {
    
    			if (--len == 0)
    				writel(*buffer | IC_STOP, &i2c_regs_p->ic_cmd_data);
    			else
    				writel(*buffer, &i2c_regs_p->ic_cmd_data);
    
    			buffer++;
    			start_time_tx = get_timer(0);
    
    		} else if (get_timer(start_time_tx) > (nb * I2C_BYTE_TO)) {
    				printf("Timed out. i2c write Failed\n");
    				return 1;
    		}
    	}
    
    	return i2c_xfer_finish();
    }
    
    /*
     * i2c_probe - Probe the i2c chip
     */
    int i2c_probe(uchar chip)
    {
    	u32 tmp;
    
    
    	/*
    	 * Try to read the first location of the chip.
    	 */
    
    	ret = i2c_read(chip, 0, 1, (uchar *)&tmp, 1);
    	if (ret)
    		i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
    
    	return ret;
    
    
    #ifdef CONFIG_I2C_MULTI_BUS
    int i2c_set_bus_num(unsigned int bus)
    {
    	switch (bus) {
    	case 0:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE;
    		break;
    #ifdef CONFIG_SYS_I2C_BASE1
    	case 1:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE1;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE2
    	case 2:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE2;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE3
    	case 3:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE3;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE4
    	case 4:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE4;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE5
    	case 5:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE5;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE6
    	case 6:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE6;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE7
    	case 7:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE7;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE8
    	case 8:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE8;
    		break;
    #endif
    #ifdef CONFIG_SYS_I2C_BASE9
    	case 9:
    		i2c_regs_p = (void *)CONFIG_SYS_I2C_BASE9;
    		break;
    #endif
    	default:
    		printf("Bad bus: %d\n", bus);
    		return -1;
    	}
    
    	current_bus = bus;
    
    	if (!bus_initialized[current_bus])
    		i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
    
    	return 0;
    }
    
    int i2c_get_bus_num(void)
    {
    	return current_bus;
    }
    #endif