Lines Matching defs:idev
92 altr_i2c_int_enable(struct altr_i2c_dev *idev, u32 mask, bool enable)
96 int_en = readl(idev->base + ALTR_I2C_ISER);
98 idev->isr_mask = int_en | mask;
100 idev->isr_mask = int_en & ~mask;
102 writel(idev->isr_mask, idev->base + ALTR_I2C_ISER);
105 static void altr_i2c_int_clear(struct altr_i2c_dev *idev, u32 mask)
107 u32 int_en = readl(idev->base + ALTR_I2C_ISR);
109 writel(int_en | mask, idev->base + ALTR_I2C_ISR);
112 static void altr_i2c_core_disable(struct altr_i2c_dev *idev)
114 u32 tmp = readl(idev->base + ALTR_I2C_CTRL);
116 writel(tmp & ~ALTR_I2C_CTRL_EN, idev->base + ALTR_I2C_CTRL);
119 static void altr_i2c_core_enable(struct altr_i2c_dev *idev)
121 u32 tmp = readl(idev->base + ALTR_I2C_CTRL);
123 writel(tmp | ALTR_I2C_CTRL_EN, idev->base + ALTR_I2C_CTRL);
126 static void altr_i2c_reset(struct altr_i2c_dev *idev)
128 altr_i2c_core_disable(idev);
129 altr_i2c_core_enable(idev);
132 static inline void altr_i2c_stop(struct altr_i2c_dev *idev)
134 writel(ALTR_I2C_TFR_CMD_STO, idev->base + ALTR_I2C_TFR_CMD);
137 static void altr_i2c_init(struct altr_i2c_dev *idev)
139 u32 divisor = clk_get_rate(idev->i2c_clk) / idev->bus_clk_rate;
140 u32 clk_mhz = clk_get_rate(idev->i2c_clk) / 1000000;
145 if (idev->bus_clk_rate <= I2C_MAX_STANDARD_MODE_FREQ) {
156 writel(tmp, idev->base + ALTR_I2C_CTRL);
158 dev_dbg(idev->dev, "rate=%uHz per_clk=%uMHz -> ratio=1:%u\n",
159 idev->bus_clk_rate, clk_mhz, divisor);
162 altr_i2c_reset(idev);
165 writel(t_high, idev->base + ALTR_I2C_SCL_HIGH);
167 writel(t_low, idev->base + ALTR_I2C_SCL_LOW);
169 writel(3 * clk_mhz / 10, idev->base + ALTR_I2C_SDA_HOLD);
172 altr_i2c_int_enable(idev, ALTR_I2C_ALL_IRQ, false);
179 static void altr_i2c_transfer(struct altr_i2c_dev *idev, u32 data)
182 if (idev->msg_len == 1)
184 if (idev->msg_len > 0)
185 writel(data, idev->base + ALTR_I2C_TFR_CMD);
192 static void altr_i2c_empty_rx_fifo(struct altr_i2c_dev *idev)
194 size_t rx_fifo_avail = readl(idev->base + ALTR_I2C_RX_FIFO_LVL);
195 int bytes_to_transfer = min(rx_fifo_avail, idev->msg_len);
198 *idev->buf++ = readl(idev->base + ALTR_I2C_RX_DATA);
199 idev->msg_len--;
200 altr_i2c_transfer(idev, 0);
208 static int altr_i2c_fill_tx_fifo(struct altr_i2c_dev *idev)
210 size_t tx_fifo_avail = idev->fifo_size - readl(idev->base +
212 int bytes_to_transfer = min(tx_fifo_avail, idev->msg_len);
213 int ret = idev->msg_len - bytes_to_transfer;
216 altr_i2c_transfer(idev, *idev->buf++);
217 idev->msg_len--;
225 struct altr_i2c_dev *idev = _dev;
229 idev->isr_status = readl(idev->base + ALTR_I2C_ISR) & idev->isr_mask;
230 if (idev->isr_status)
240 struct altr_i2c_dev *idev = _dev;
241 u32 status = idev->isr_status;
243 mutex_lock(&idev->isr_mutex);
244 if (!idev->msg) {
245 dev_warn(idev->dev, "unexpected interrupt\n");
246 altr_i2c_int_clear(idev, ALTR_I2C_ALL_IRQ);
249 read = (idev->msg->flags & I2C_M_RD) != 0;
253 altr_i2c_int_clear(idev, ALTR_I2C_ISR_ARB);
254 idev->msg_err = -EAGAIN;
257 dev_dbg(idev->dev, "Could not get ACK\n");
258 idev->msg_err = -ENXIO;
259 altr_i2c_int_clear(idev, ALTR_I2C_ISR_NACK);
260 altr_i2c_stop(idev);
264 altr_i2c_empty_rx_fifo(idev);
265 altr_i2c_int_clear(idev, ALTR_I2C_ISR_RXRDY);
266 altr_i2c_stop(idev);
267 dev_err(idev->dev, "RX FIFO Overflow\n");
271 altr_i2c_empty_rx_fifo(idev);
272 altr_i2c_int_clear(idev, ALTR_I2C_ISR_RXRDY);
273 if (!idev->msg_len)
277 altr_i2c_int_clear(idev, ALTR_I2C_ISR_TXRDY);
278 if (idev->msg_len > 0)
279 altr_i2c_fill_tx_fifo(idev);
283 dev_warn(idev->dev, "Unexpected interrupt: 0x%x\n", status);
284 altr_i2c_int_clear(idev, ALTR_I2C_ALL_IRQ);
289 ret = readl_poll_timeout_atomic(idev->base + ALTR_I2C_STATUS,
294 dev_err(idev->dev, "message timeout\n");
295 altr_i2c_int_enable(idev, ALTR_I2C_ALL_IRQ, false);
296 altr_i2c_int_clear(idev, ALTR_I2C_ALL_IRQ);
297 complete(&idev->msg_complete);
298 dev_dbg(idev->dev, "Message Complete\n");
301 mutex_unlock(&idev->isr_mutex);
306 static int altr_i2c_xfer_msg(struct altr_i2c_dev *idev, struct i2c_msg *msg)
313 mutex_lock(&idev->isr_mutex);
314 idev->msg = msg;
315 idev->msg_len = msg->len;
316 idev->buf = msg->buf;
317 idev->msg_err = 0;
318 reinit_completion(&idev->msg_complete);
319 altr_i2c_core_enable(idev);
323 readl(idev->base + ALTR_I2C_RX_DATA);
324 } while (readl(idev->base + ALTR_I2C_RX_FIFO_LVL));
326 writel(ALTR_I2C_TFR_CMD_STA | addr, idev->base + ALTR_I2C_TFR_CMD);
330 altr_i2c_int_enable(idev, imask, true);
332 altr_i2c_transfer(idev, 0);
335 altr_i2c_int_enable(idev, imask, true);
336 altr_i2c_fill_tx_fifo(idev);
338 mutex_unlock(&idev->isr_mutex);
340 time_left = wait_for_completion_timeout(&idev->msg_complete,
342 mutex_lock(&idev->isr_mutex);
343 altr_i2c_int_enable(idev, imask, false);
345 value = readl(idev->base + ALTR_I2C_STATUS) & ALTR_I2C_STAT_CORE;
347 dev_err(idev->dev, "Core Status not IDLE...\n");
350 idev->msg_err = -ETIMEDOUT;
351 dev_dbg(idev->dev, "Transaction timed out.\n");
354 altr_i2c_core_disable(idev);
355 mutex_unlock(&idev->isr_mutex);
357 return idev->msg_err;
363 struct altr_i2c_dev *idev = i2c_get_adapdata(adap);
367 ret = altr_i2c_xfer_msg(idev, msgs++);
386 struct altr_i2c_dev *idev = NULL;
389 idev = devm_kzalloc(&pdev->dev, sizeof(*idev), GFP_KERNEL);
390 if (!idev)
393 idev->base = devm_platform_ioremap_resource(pdev, 0);
394 if (IS_ERR(idev->base))
395 return PTR_ERR(idev->base);
401 idev->i2c_clk = devm_clk_get(&pdev->dev, NULL);
402 if (IS_ERR(idev->i2c_clk)) {
404 return PTR_ERR(idev->i2c_clk);
407 idev->dev = &pdev->dev;
408 init_completion(&idev->msg_complete);
409 mutex_init(&idev->isr_mutex);
411 ret = device_property_read_u32(idev->dev, "fifo-size",
412 &idev->fifo_size);
416 idev->fifo_size = ALTR_I2C_DFLT_FIFO_SZ;
419 ret = device_property_read_u32(idev->dev, "clock-frequency",
420 &idev->bus_clk_rate);
423 idev->bus_clk_rate = I2C_MAX_STANDARD_MODE_FREQ; /* default clock rate */
426 if (idev->bus_clk_rate > I2C_MAX_FAST_MODE_FREQ) {
428 idev->bus_clk_rate);
434 pdev->name, idev);
440 ret = clk_prepare_enable(idev->i2c_clk);
446 mutex_lock(&idev->isr_mutex);
447 altr_i2c_init(idev);
448 mutex_unlock(&idev->isr_mutex);
450 i2c_set_adapdata(&idev->adapter, idev);
451 strlcpy(idev->adapter.name, pdev->name, sizeof(idev->adapter.name));
452 idev->adapter.owner = THIS_MODULE;
453 idev->adapter.algo = &altr_i2c_algo;
454 idev->adapter.dev.parent = &pdev->dev;
455 idev->adapter.dev.of_node = pdev->dev.of_node;
457 platform_set_drvdata(pdev, idev);
459 ret = i2c_add_adapter(&idev->adapter);
461 clk_disable_unprepare(idev->i2c_clk);
471 struct altr_i2c_dev *idev = platform_get_drvdata(pdev);
473 clk_disable_unprepare(idev->i2c_clk);
474 i2c_del_adapter(&idev->adapter);