[PATCH v3 1/2] i2c: Add driver for Cadence I2C controller

Sören Brinkmann soren.brinkmann at xilinx.com
Tue Apr 1 14:24:36 PDT 2014


On Tue, 2014-04-01 at 02:50AM +0200, Wolfram Sang wrote:
> On Tue, Mar 11, 2014 at 09:50:12AM -0700, Soren Brinkmann wrote:
> > Add a driver for the Cadence I2C controller. This controller is for
> > example found in Xilinx Zynq.
> > 
> > Signed-off-by: Soren Brinkmann <soren.brinkmann at xilinx.com>
> 
> ...
> 
> > +static irqreturn_t cdns_i2c_isr(int irq, void *ptr)
> > +{
> > +	unsigned int isr_status, avail_bytes;
> > +	unsigned int bytes_to_recv, bytes_to_send;
> > +	struct cdns_i2c *id = ptr;
> > +	/* Signal completion only after everything is updated */
> > +	int done_flag = 0;
> > +
> > +	isr_status = cdns_i2c_readreg(CDNS_I2C_ISR_OFFSET);
> > +
> > +	/* Handling nack and arbitration lost interrupt */
> > +	if (isr_status & (CDNS_I2C_IXR_NACK | CDNS_I2C_IXR_ARB_LOST))
> > +		done_flag = 1;
> > +
> > +	/* Handling Data interrupt */
> > +	if ((isr_status & CDNS_I2C_IXR_DATA) &&
> > +			(id->recv_count >= CDNS_I2C_DATA_INTR_DEPTH)) {
> > +		/* Always read data interrupt threshold bytes */
> > +		bytes_to_recv = CDNS_I2C_DATA_INTR_DEPTH;
> > +		id->recv_count = id->recv_count - CDNS_I2C_DATA_INTR_DEPTH;
> 
> Use '-='
> 
> ...
> 
> > +static int cdns_i2c_process_msg(struct cdns_i2c *id, struct i2c_msg *msg,
> > +		struct i2c_adapter *adap)
> > +{
> > +	int ret;
> > +	u32 reg;
> > +	bool retry = false;
> > +	unsigned retries = adap->retries;
> > +
> > +	id->p_msg = msg;
> > +	do {
> > +		id->err_status = 0;
> > +		init_completion(&id->xfer_done);
> 
> reinit_completion. And add init_completion in probe.
> 
> > +
> > +		/* Check for the TEN Bit mode on each msg */
> > +		reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
> > +		if (msg->flags & I2C_M_TEN) {
> > +			if (reg & CDNS_I2C_CR_NEA)
> > +				cdns_i2c_writereg(reg & ~CDNS_I2C_CR_NEA,
> > +						CDNS_I2C_CR_OFFSET);
> > +		} else {
> > +			if (!(reg & CDNS_I2C_CR_NEA))
> > +				cdns_i2c_writereg(reg | CDNS_I2C_CR_NEA,
> > +						CDNS_I2C_CR_OFFSET);
> > +		}
> > +
> > +		/* Check for the R/W flag on each msg */
> > +		if (msg->flags & I2C_M_RD)
> > +			cdns_i2c_mrecv(id);
> > +		else
> > +			cdns_i2c_msend(id);
> > +
> > +		/* Wait for the signal of completion */
> > +		ret = wait_for_completion_timeout(&id->xfer_done, HZ);
> > +		if (!ret) {
> > +			cdns_i2c_master_reset(adap);
> > +			dev_err(id->adap.dev.parent,
> > +					"timeout waiting on completion\n");
> > +			return -ETIMEDOUT;
> > +		}
> > +
> > +		cdns_i2c_writereg(CDNS_I2C_IXR_ALL_INTR_MASK,
> > +				  CDNS_I2C_IDR_OFFSET);
> > +
> > +		/* If it is bus arbitration error, try again */
> > +		if (id->err_status & CDNS_I2C_IXR_ARB_LOST) {
> 
> Just return -EAGAIN here...
> 
> > +			dev_dbg(id->adap.dev.parent,
> > +				 "Lost ownership on bus, trying again\n");
> > +			if (retries--) {
> > +				mdelay(2);
> > +				retry = true;
> > +			} else {
> > +				dev_err(id->adap.dev.parent,
> > +					 "Retries completed, exit\n");
> > +				return -EREMOTEIO;
> > +			}
> > +		}
> 
> ... and you can skip this block since the core will do the retries.
> 
> > +	} while (retry);
> > +
> > +	return 0;
> > +}
> > +
> > +/**
> > + * cdns_i2c_master_xfer - The main i2c transfer function
> > + * @adap:	pointer to the i2c adapter driver instance
> > + * @msgs:	pointer to the i2c message structure
> > + * @num:	the number of messages to transfer
> > + *
> > + * Return: number of msgs processed on success, negative error otherwise
> > + *
> > + * This function waits for the bus idle condition and updates the timeout if
> > + * modified by user. Then initiates the send/recv activity based on the
> > + * transfer message received.
> > + */
> > +static int cdns_i2c_master_xfer(struct i2c_adapter *adap, struct i2c_msg *msgs,
> > +				int num)
> > +{
> > +	struct cdns_i2c *id = adap->algo_data;
> > +	unsigned long timeout;
> > +	int ret, count;
> > +	u32 reg;
> > +
> > +	/* Waiting for bus-ready. If bus not ready, it returns after timeout */
> > +	timeout = jiffies + CDNS_I2C_TIMEOUT;
> > +	while (cdns_i2c_readreg(CDNS_I2C_SR_OFFSET) & CDNS_I2C_SR_BA) {
> > +		if (time_after(jiffies, timeout)) {
> > +			dev_warn(id->adap.dev.parent,
> > +					"timedout waiting for bus ready\n");
> > +			cdns_i2c_master_reset(adap);
> > +			return -ETIMEDOUT;
> > +		}
> > +		schedule_timeout(1);
> > +	}
> > +
> > +	/* The bus is free. Set the new timeout value if updated */
> > +	if (id->adap.timeout != id->cur_timeout) {
> > +		cdns_i2c_writereg(id->adap.timeout & CDNS_I2C_TIME_OUT_TO_MASK,
> > +					CDNS_I2C_TIME_OUT_OFFSET);
> > +		id->cur_timeout = id->adap.timeout;
> > +	}
> > +
> > +	/*
> > +	 * Set the flag to one when multiple messages are to be
> > +	 * processed with a repeated start.
> > +	 */
> > +	if (num > 1) {
> > +		id->bus_hold_flag = 1;
> > +		reg = cdns_i2c_readreg(CDNS_I2C_CR_OFFSET);
> > +		reg |= CDNS_I2C_CR_HOLD;
> > +		cdns_i2c_writereg(reg, CDNS_I2C_CR_OFFSET);
> > +	} else {
> > +		id->bus_hold_flag = 0;
> > +	}
> > +
> > +	/* Process the msg one by one */
> > +	for (count = 0; count < num; count++, msgs++) {
> > +		if (count == (num - 1))
> > +			id->bus_hold_flag = 0;
> > +
> > +		ret = cdns_i2c_process_msg(id, msgs, adap);
> > +		if (ret)
> > +			return ret;
> > +
> > +		/* Report the other error interrupts to application as EIO */
> > +		if (id->err_status & 0xE4) {
> 
> Please replace this magic hex value with something readable.
> 
> > +			cdns_i2c_master_reset(adap);
> > +			return -EIO;
> > +		}
> > +	}
> > +
> > +	return num;
> > +}
> > +
> 
> ...
> 
> > +/**
> > + * cdns_i2c_probe - Platform registration call
> > + * @pdev:	Handle to the platform device structure
> > + *
> > + * Return: 0 on success, negative error otherwise
> > + *
> > + * This function does all the memory allocation and registration for the i2c
> > + * device. User can modify the address mode to 10 bit address mode using the
> > + * ioctl call with option I2C_TENBIT.
> > + */
> > +static int cdns_i2c_probe(struct platform_device *pdev)
> > +{
> > +	struct resource *r_mem;
> > +	struct cdns_i2c *id;
> > +	int ret;
> > +
> > +	id = devm_kzalloc(&pdev->dev, sizeof(*id), GFP_KERNEL);
> > +	if (!id)
> > +		return -ENOMEM;
> > +
> > +	platform_set_drvdata(pdev, id);
> > +
> > +	r_mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
> > +	id->membase = devm_ioremap_resource(&pdev->dev, r_mem);
> > +	if (IS_ERR(id->membase))
> > +		return PTR_ERR(id->membase);
> > +
> > +	id->irq = platform_get_irq(pdev, 0);
> > +
> > +	id->adap.nr = pdev->id;
> 
> Drop this line and use i2c_add_adapter() later to let the core handle
> the numbering. This will also take aliases into account.
> 
> > +	id->adap.dev.of_node = pdev->dev.of_node;
> > +	id->adap.algo = &cdns_i2c_algo;
> > +	id->adap.timeout = 0x1F;	/* Default timeout value */
> 
> This value is in jiffies, so you probably want to use msecs_to_jiffies
> or alike.
> 
> > +	id->adap.retries = 3;		/* Default retry value. */
> > +	id->adap.algo_data = id;
> > +	id->adap.dev.parent = &pdev->dev;
> > +	snprintf(id->adap.name, sizeof(id->adap.name),
> > +		 "Cadence I2C at %08lx", (unsigned long)r_mem->start);
> > +
> > +	id->cur_timeout = id->adap.timeout;
> > +	id->clk = devm_clk_get(&pdev->dev, NULL);
> > +	if (IS_ERR(id->clk)) {
> > +		dev_err(&pdev->dev, "input clock not found.\n");
> > +		return PTR_ERR(id->clk);
> > +	}
> > +	ret = clk_prepare_enable(id->clk);
> > +	if (ret) {
> > +		dev_err(&pdev->dev, "Unable to enable clock.\n");
> > +		return ret;
> > +	}
> > +	id->clk_rate_change_nb.notifier_call = cdns_i2c_clk_notifier_cb;
> > +	if (clk_notifier_register(id->clk, &id->clk_rate_change_nb))
> > +		dev_warn(&pdev->dev, "Unable to register clock notifier.\n");
> > +	id->input_clk = clk_get_rate(id->clk);
> > +
> > +	ret = of_property_read_u32(pdev->dev.of_node, "clock-frequency",
> > +			&id->i2c_clk);
> > +	if (ret || (id->i2c_clk > CDNS_I2C_SPEED_MAX))
> > +		id->i2c_clk = CDNS_I2C_SPEED_MAX;
> > +
> > +	cdns_i2c_writereg(0xE, CDNS_I2C_CR_OFFSET);
> 
> Remove magic value. Please check the driver for more, in case I missed
> some.

Thanks for reviewing. I'll work on the next iteration.

	Sören





More information about the linux-arm-kernel mailing list