1 // SPDX-License-Identifier: GPL-2.0 2 // Copyright (c) 2012-2016, The Linux Foundation. All rights reserved. 3 // Copyright (c) 2017-20 Linaro Limited. 4 5 #include <linux/clk.h> 6 #include <linux/completion.h> 7 #include <linux/i2c.h> 8 #include <linux/io.h> 9 #include <linux/interrupt.h> 10 #include <linux/module.h> 11 #include <linux/of.h> 12 #include <linux/platform_device.h> 13 #include <linux/pm_runtime.h> 14 15 #define CCI_HW_VERSION 0x0 16 #define CCI_RESET_CMD 0x004 17 #define CCI_RESET_CMD_MASK 0x0f73f3f7 18 #define CCI_RESET_CMD_M0_MASK 0x000003f1 19 #define CCI_RESET_CMD_M1_MASK 0x0003f001 20 #define CCI_QUEUE_START 0x008 21 #define CCI_HALT_REQ 0x034 22 #define CCI_HALT_REQ_I2C_M0_Q0Q1 BIT(0) 23 #define CCI_HALT_REQ_I2C_M1_Q0Q1 BIT(1) 24 25 #define CCI_I2C_Mm_SCL_CTL(m) (0x100 + 0x100 * (m)) 26 #define CCI_I2C_Mm_SDA_CTL_0(m) (0x104 + 0x100 * (m)) 27 #define CCI_I2C_Mm_SDA_CTL_1(m) (0x108 + 0x100 * (m)) 28 #define CCI_I2C_Mm_SDA_CTL_2(m) (0x10c + 0x100 * (m)) 29 #define CCI_I2C_Mm_MISC_CTL(m) (0x110 + 0x100 * (m)) 30 31 #define CCI_I2C_Mm_READ_DATA(m) (0x118 + 0x100 * (m)) 32 #define CCI_I2C_Mm_READ_BUF_LEVEL(m) (0x11c + 0x100 * (m)) 33 #define CCI_I2C_Mm_Qn_EXEC_WORD_CNT(m, n) (0x300 + 0x200 * (m) + 0x100 * (n)) 34 #define CCI_I2C_Mm_Qn_CUR_WORD_CNT(m, n) (0x304 + 0x200 * (m) + 0x100 * (n)) 35 #define CCI_I2C_Mm_Qn_CUR_CMD(m, n) (0x308 + 0x200 * (m) + 0x100 * (n)) 36 #define CCI_I2C_Mm_Qn_REPORT_STATUS(m, n) (0x30c + 0x200 * (m) + 0x100 * (n)) 37 #define CCI_I2C_Mm_Qn_LOAD_DATA(m, n) (0x310 + 0x200 * (m) + 0x100 * (n)) 38 39 #define CCI_IRQ_GLOBAL_CLEAR_CMD 0xc00 40 #define CCI_IRQ_MASK_0 0xc04 41 #define CCI_IRQ_MASK_0_I2C_M0_RD_DONE BIT(0) 42 #define CCI_IRQ_MASK_0_I2C_M0_Q0_REPORT BIT(4) 43 #define CCI_IRQ_MASK_0_I2C_M0_Q1_REPORT BIT(8) 44 #define CCI_IRQ_MASK_0_I2C_M1_RD_DONE BIT(12) 45 #define CCI_IRQ_MASK_0_I2C_M1_Q0_REPORT BIT(16) 46 #define CCI_IRQ_MASK_0_I2C_M1_Q1_REPORT BIT(20) 47 #define CCI_IRQ_MASK_0_RST_DONE_ACK BIT(24) 48 #define CCI_IRQ_MASK_0_I2C_M0_Q0Q1_HALT_ACK BIT(25) 49 #define CCI_IRQ_MASK_0_I2C_M1_Q0Q1_HALT_ACK BIT(26) 50 #define CCI_IRQ_MASK_0_I2C_M0_ERROR 0x18000ee6 51 #define CCI_IRQ_MASK_0_I2C_M1_ERROR 0x60ee6000 52 #define CCI_IRQ_CLEAR_0 0xc08 53 #define CCI_IRQ_STATUS_0 0xc0c 54 #define CCI_IRQ_STATUS_0_I2C_M0_RD_DONE BIT(0) 55 #define CCI_IRQ_STATUS_0_I2C_M0_Q0_REPORT BIT(4) 56 #define CCI_IRQ_STATUS_0_I2C_M0_Q1_REPORT BIT(8) 57 #define CCI_IRQ_STATUS_0_I2C_M1_RD_DONE BIT(12) 58 #define CCI_IRQ_STATUS_0_I2C_M1_Q0_REPORT BIT(16) 59 #define CCI_IRQ_STATUS_0_I2C_M1_Q1_REPORT BIT(20) 60 #define CCI_IRQ_STATUS_0_RST_DONE_ACK BIT(24) 61 #define CCI_IRQ_STATUS_0_I2C_M0_Q0Q1_HALT_ACK BIT(25) 62 #define CCI_IRQ_STATUS_0_I2C_M1_Q0Q1_HALT_ACK BIT(26) 63 #define CCI_IRQ_STATUS_0_I2C_M0_Q0_NACK_ERR BIT(27) 64 #define CCI_IRQ_STATUS_0_I2C_M0_Q1_NACK_ERR BIT(28) 65 #define CCI_IRQ_STATUS_0_I2C_M1_Q0_NACK_ERR BIT(29) 66 #define CCI_IRQ_STATUS_0_I2C_M1_Q1_NACK_ERR BIT(30) 67 #define CCI_IRQ_STATUS_0_I2C_M0_ERROR 0x18000ee6 68 #define CCI_IRQ_STATUS_0_I2C_M1_ERROR 0x60ee6000 69 70 #define CCI_TIMEOUT (msecs_to_jiffies(100)) 71 #define NUM_MASTERS 2 72 #define NUM_QUEUES 2 73 74 /* Max number of resources + 1 for a NULL terminator */ 75 #define CCI_RES_MAX 6 76 77 #define CCI_I2C_SET_PARAM 1 78 #define CCI_I2C_REPORT 8 79 #define CCI_I2C_WRITE 9 80 #define CCI_I2C_READ 10 81 82 #define CCI_I2C_REPORT_IRQ_EN BIT(8) 83 84 enum { 85 I2C_MODE_STANDARD, 86 I2C_MODE_FAST, 87 I2C_MODE_FAST_PLUS, 88 }; 89 90 enum cci_i2c_queue_t { 91 QUEUE_0, 92 QUEUE_1 93 }; 94 95 struct hw_params { 96 u16 thigh; /* HIGH period of the SCL clock in clock ticks */ 97 u16 tlow; /* LOW period of the SCL clock */ 98 u16 tsu_sto; /* set-up time for STOP condition */ 99 u16 tsu_sta; /* set-up time for a repeated START condition */ 100 u16 thd_dat; /* data hold time */ 101 u16 thd_sta; /* hold time (repeated) START condition */ 102 u16 tbuf; /* bus free time between a STOP and START condition */ 103 u8 scl_stretch_en; 104 u16 trdhld; 105 u16 tsp; /* pulse width of spikes suppressed by the input filter */ 106 }; 107 108 struct cci; 109 110 struct cci_master { 111 struct i2c_adapter adap; 112 u16 master; 113 u8 mode; 114 int status; 115 struct completion irq_complete; 116 struct cci *cci; 117 }; 118 119 struct cci_data { 120 unsigned int num_masters; 121 struct i2c_adapter_quirks quirks; 122 u16 queue_size[NUM_QUEUES]; 123 unsigned long cci_clk_rate; 124 struct hw_params params[3]; 125 }; 126 127 struct cci { 128 struct device *dev; 129 void __iomem *base; 130 unsigned int irq; 131 const struct cci_data *data; 132 struct clk_bulk_data *clocks; 133 int nclocks; 134 struct cci_master master[NUM_MASTERS]; 135 }; 136 137 static irqreturn_t cci_isr(int irq, void *dev) 138 { 139 struct cci *cci = dev; 140 u32 val, reset = 0; 141 int ret = IRQ_NONE; 142 143 val = readl(cci->base + CCI_IRQ_STATUS_0); 144 writel(val, cci->base + CCI_IRQ_CLEAR_0); 145 writel(0x1, cci->base + CCI_IRQ_GLOBAL_CLEAR_CMD); 146 147 if (val & CCI_IRQ_STATUS_0_RST_DONE_ACK) { 148 complete(&cci->master[0].irq_complete); 149 if (cci->master[1].master) 150 complete(&cci->master[1].irq_complete); 151 ret = IRQ_HANDLED; 152 } 153 154 if (val & CCI_IRQ_STATUS_0_I2C_M0_RD_DONE || 155 val & CCI_IRQ_STATUS_0_I2C_M0_Q0_REPORT || 156 val & CCI_IRQ_STATUS_0_I2C_M0_Q1_REPORT) { 157 cci->master[0].status = 0; 158 complete(&cci->master[0].irq_complete); 159 ret = IRQ_HANDLED; 160 } 161 162 if (val & CCI_IRQ_STATUS_0_I2C_M1_RD_DONE || 163 val & CCI_IRQ_STATUS_0_I2C_M1_Q0_REPORT || 164 val & CCI_IRQ_STATUS_0_I2C_M1_Q1_REPORT) { 165 cci->master[1].status = 0; 166 complete(&cci->master[1].irq_complete); 167 ret = IRQ_HANDLED; 168 } 169 170 if (unlikely(val & CCI_IRQ_STATUS_0_I2C_M0_Q0Q1_HALT_ACK)) { 171 reset = CCI_RESET_CMD_M0_MASK; 172 ret = IRQ_HANDLED; 173 } 174 175 if (unlikely(val & CCI_IRQ_STATUS_0_I2C_M1_Q0Q1_HALT_ACK)) { 176 reset = CCI_RESET_CMD_M1_MASK; 177 ret = IRQ_HANDLED; 178 } 179 180 if (unlikely(reset)) 181 writel(reset, cci->base + CCI_RESET_CMD); 182 183 if (unlikely(val & CCI_IRQ_STATUS_0_I2C_M0_ERROR)) { 184 if (val & CCI_IRQ_STATUS_0_I2C_M0_Q0_NACK_ERR || 185 val & CCI_IRQ_STATUS_0_I2C_M0_Q1_NACK_ERR) 186 cci->master[0].status = -ENXIO; 187 else 188 cci->master[0].status = -EIO; 189 190 writel(CCI_HALT_REQ_I2C_M0_Q0Q1, cci->base + CCI_HALT_REQ); 191 ret = IRQ_HANDLED; 192 } 193 194 if (unlikely(val & CCI_IRQ_STATUS_0_I2C_M1_ERROR)) { 195 if (val & CCI_IRQ_STATUS_0_I2C_M1_Q0_NACK_ERR || 196 val & CCI_IRQ_STATUS_0_I2C_M1_Q1_NACK_ERR) 197 cci->master[1].status = -ENXIO; 198 else 199 cci->master[1].status = -EIO; 200 201 writel(CCI_HALT_REQ_I2C_M1_Q0Q1, cci->base + CCI_HALT_REQ); 202 ret = IRQ_HANDLED; 203 } 204 205 return ret; 206 } 207 208 static int cci_halt(struct cci *cci, u8 master_num) 209 { 210 struct cci_master *master; 211 u32 val; 212 213 if (master_num >= cci->data->num_masters) { 214 dev_err(cci->dev, "Unsupported master idx (%u)\n", master_num); 215 return -EINVAL; 216 } 217 218 val = BIT(master_num); 219 master = &cci->master[master_num]; 220 221 reinit_completion(&master->irq_complete); 222 writel(val, cci->base + CCI_HALT_REQ); 223 224 if (!wait_for_completion_timeout(&master->irq_complete, CCI_TIMEOUT)) { 225 dev_err(cci->dev, "CCI halt timeout\n"); 226 return -ETIMEDOUT; 227 } 228 229 return 0; 230 } 231 232 static int cci_reset(struct cci *cci) 233 { 234 /* 235 * we reset the whole controller, here and for implicity use 236 * master[0].xxx for waiting on it. 237 */ 238 reinit_completion(&cci->master[0].irq_complete); 239 writel(CCI_RESET_CMD_MASK, cci->base + CCI_RESET_CMD); 240 241 if (!wait_for_completion_timeout(&cci->master[0].irq_complete, 242 CCI_TIMEOUT)) { 243 dev_err(cci->dev, "CCI reset timeout\n"); 244 return -ETIMEDOUT; 245 } 246 247 return 0; 248 } 249 250 static int cci_init(struct cci *cci) 251 { 252 u32 val = CCI_IRQ_MASK_0_I2C_M0_RD_DONE | 253 CCI_IRQ_MASK_0_I2C_M0_Q0_REPORT | 254 CCI_IRQ_MASK_0_I2C_M0_Q1_REPORT | 255 CCI_IRQ_MASK_0_I2C_M1_RD_DONE | 256 CCI_IRQ_MASK_0_I2C_M1_Q0_REPORT | 257 CCI_IRQ_MASK_0_I2C_M1_Q1_REPORT | 258 CCI_IRQ_MASK_0_RST_DONE_ACK | 259 CCI_IRQ_MASK_0_I2C_M0_Q0Q1_HALT_ACK | 260 CCI_IRQ_MASK_0_I2C_M1_Q0Q1_HALT_ACK | 261 CCI_IRQ_MASK_0_I2C_M0_ERROR | 262 CCI_IRQ_MASK_0_I2C_M1_ERROR; 263 int i; 264 265 writel(val, cci->base + CCI_IRQ_MASK_0); 266 267 for (i = 0; i < cci->data->num_masters; i++) { 268 int mode = cci->master[i].mode; 269 const struct hw_params *hw; 270 271 if (!cci->master[i].cci) 272 continue; 273 274 hw = &cci->data->params[mode]; 275 276 val = hw->thigh << 16 | hw->tlow; 277 writel(val, cci->base + CCI_I2C_Mm_SCL_CTL(i)); 278 279 val = hw->tsu_sto << 16 | hw->tsu_sta; 280 writel(val, cci->base + CCI_I2C_Mm_SDA_CTL_0(i)); 281 282 val = hw->thd_dat << 16 | hw->thd_sta; 283 writel(val, cci->base + CCI_I2C_Mm_SDA_CTL_1(i)); 284 285 val = hw->tbuf; 286 writel(val, cci->base + CCI_I2C_Mm_SDA_CTL_2(i)); 287 288 val = hw->scl_stretch_en << 8 | hw->trdhld << 4 | hw->tsp; 289 writel(val, cci->base + CCI_I2C_Mm_MISC_CTL(i)); 290 } 291 292 return 0; 293 } 294 295 static int cci_run_queue(struct cci *cci, u8 master, u8 queue) 296 { 297 u32 val; 298 299 val = readl(cci->base + CCI_I2C_Mm_Qn_CUR_WORD_CNT(master, queue)); 300 writel(val, cci->base + CCI_I2C_Mm_Qn_EXEC_WORD_CNT(master, queue)); 301 302 reinit_completion(&cci->master[master].irq_complete); 303 val = BIT(master * 2 + queue); 304 writel(val, cci->base + CCI_QUEUE_START); 305 306 if (!wait_for_completion_timeout(&cci->master[master].irq_complete, 307 CCI_TIMEOUT)) { 308 dev_err(cci->dev, "master %d queue %d timeout\n", 309 master, queue); 310 cci_reset(cci); 311 cci_init(cci); 312 return -ETIMEDOUT; 313 } 314 315 return cci->master[master].status; 316 } 317 318 static int cci_validate_queue(struct cci *cci, u8 master, u8 queue) 319 { 320 u32 val; 321 322 val = readl(cci->base + CCI_I2C_Mm_Qn_CUR_WORD_CNT(master, queue)); 323 if (val == cci->data->queue_size[queue]) 324 return -EINVAL; 325 326 if (!val) 327 return 0; 328 329 val = CCI_I2C_REPORT | CCI_I2C_REPORT_IRQ_EN; 330 writel(val, cci->base + CCI_I2C_Mm_Qn_LOAD_DATA(master, queue)); 331 332 return cci_run_queue(cci, master, queue); 333 } 334 335 static int cci_i2c_read(struct cci *cci, u16 master, 336 u16 addr, u8 *buf, u16 len) 337 { 338 u32 val, words_read, words_exp; 339 u8 queue = QUEUE_1; 340 int i, index = 0, ret; 341 bool first = true; 342 343 /* 344 * Call validate queue to make sure queue is empty before starting. 345 * This is to avoid overflow / underflow of queue. 346 */ 347 ret = cci_validate_queue(cci, master, queue); 348 if (ret < 0) 349 return ret; 350 351 val = CCI_I2C_SET_PARAM | (addr & 0x7f) << 4; 352 writel(val, cci->base + CCI_I2C_Mm_Qn_LOAD_DATA(master, queue)); 353 354 val = CCI_I2C_READ | len << 4; 355 writel(val, cci->base + CCI_I2C_Mm_Qn_LOAD_DATA(master, queue)); 356 357 ret = cci_run_queue(cci, master, queue); 358 if (ret < 0) 359 return ret; 360 361 words_read = readl(cci->base + CCI_I2C_Mm_READ_BUF_LEVEL(master)); 362 words_exp = len / 4 + 1; 363 if (words_read != words_exp) { 364 dev_err(cci->dev, "words read = %d, words expected = %d\n", 365 words_read, words_exp); 366 return -EIO; 367 } 368 369 do { 370 val = readl(cci->base + CCI_I2C_Mm_READ_DATA(master)); 371 372 for (i = 0; i < 4 && index < len; i++) { 373 if (first) { 374 /* The LS byte of this register represents the 375 * first byte read from the slave during a read 376 * access. 377 */ 378 first = false; 379 continue; 380 } 381 buf[index++] = (val >> (i * 8)) & 0xff; 382 } 383 } while (--words_read); 384 385 return 0; 386 } 387 388 static int cci_i2c_write(struct cci *cci, u16 master, 389 u16 addr, u8 *buf, u16 len) 390 { 391 u8 queue = QUEUE_0; 392 u8 load[12] = { 0 }; 393 int i = 0, j, ret; 394 u32 val; 395 396 /* 397 * Call validate queue to make sure queue is empty before starting. 398 * This is to avoid overflow / underflow of queue. 399 */ 400 ret = cci_validate_queue(cci, master, queue); 401 if (ret < 0) 402 return ret; 403 404 val = CCI_I2C_SET_PARAM | (addr & 0x7f) << 4; 405 writel(val, cci->base + CCI_I2C_Mm_Qn_LOAD_DATA(master, queue)); 406 407 load[i++] = CCI_I2C_WRITE | len << 4; 408 409 for (j = 0; j < len; j++) 410 load[i++] = buf[j]; 411 412 for (j = 0; j < i; j += 4) { 413 val = load[j]; 414 val |= load[j + 1] << 8; 415 val |= load[j + 2] << 16; 416 val |= load[j + 3] << 24; 417 writel(val, cci->base + CCI_I2C_Mm_Qn_LOAD_DATA(master, queue)); 418 } 419 420 val = CCI_I2C_REPORT | CCI_I2C_REPORT_IRQ_EN; 421 writel(val, cci->base + CCI_I2C_Mm_Qn_LOAD_DATA(master, queue)); 422 423 return cci_run_queue(cci, master, queue); 424 } 425 426 static int cci_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[], int num) 427 { 428 struct cci_master *cci_master = i2c_get_adapdata(adap); 429 struct cci *cci = cci_master->cci; 430 int i, ret; 431 432 ret = pm_runtime_get_sync(cci->dev); 433 if (ret < 0) 434 goto err; 435 436 for (i = 0; i < num; i++) { 437 if (msgs[i].flags & I2C_M_RD) 438 ret = cci_i2c_read(cci, cci_master->master, 439 msgs[i].addr, msgs[i].buf, 440 msgs[i].len); 441 else 442 ret = cci_i2c_write(cci, cci_master->master, 443 msgs[i].addr, msgs[i].buf, 444 msgs[i].len); 445 446 if (ret < 0) 447 break; 448 } 449 450 if (!ret) 451 ret = num; 452 453 err: 454 pm_runtime_mark_last_busy(cci->dev); 455 pm_runtime_put_autosuspend(cci->dev); 456 457 return ret; 458 } 459 460 static u32 cci_func(struct i2c_adapter *adap) 461 { 462 return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; 463 } 464 465 static const struct i2c_algorithm cci_algo = { 466 .master_xfer = cci_xfer, 467 .functionality = cci_func, 468 }; 469 470 static int cci_enable_clocks(struct cci *cci) 471 { 472 return clk_bulk_prepare_enable(cci->nclocks, cci->clocks); 473 } 474 475 static void cci_disable_clocks(struct cci *cci) 476 { 477 clk_bulk_disable_unprepare(cci->nclocks, cci->clocks); 478 } 479 480 static int __maybe_unused cci_suspend_runtime(struct device *dev) 481 { 482 struct cci *cci = dev_get_drvdata(dev); 483 484 cci_disable_clocks(cci); 485 return 0; 486 } 487 488 static int __maybe_unused cci_resume_runtime(struct device *dev) 489 { 490 struct cci *cci = dev_get_drvdata(dev); 491 int ret; 492 493 ret = cci_enable_clocks(cci); 494 if (ret) 495 return ret; 496 497 cci_init(cci); 498 return 0; 499 } 500 501 static int __maybe_unused cci_suspend(struct device *dev) 502 { 503 if (!pm_runtime_suspended(dev)) 504 return cci_suspend_runtime(dev); 505 506 return 0; 507 } 508 509 static int __maybe_unused cci_resume(struct device *dev) 510 { 511 cci_resume_runtime(dev); 512 pm_runtime_mark_last_busy(dev); 513 pm_request_autosuspend(dev); 514 515 return 0; 516 } 517 518 static const struct dev_pm_ops qcom_cci_pm = { 519 SET_SYSTEM_SLEEP_PM_OPS(cci_suspend, cci_resume) 520 SET_RUNTIME_PM_OPS(cci_suspend_runtime, cci_resume_runtime, NULL) 521 }; 522 523 static int cci_probe(struct platform_device *pdev) 524 { 525 struct device *dev = &pdev->dev; 526 unsigned long cci_clk_rate = 0; 527 struct device_node *child; 528 struct resource *r; 529 struct cci *cci; 530 int ret, i; 531 u32 val; 532 533 cci = devm_kzalloc(dev, sizeof(*cci), GFP_KERNEL); 534 if (!cci) 535 return -ENOMEM; 536 537 cci->dev = dev; 538 platform_set_drvdata(pdev, cci); 539 cci->data = device_get_match_data(dev); 540 if (!cci->data) 541 return -ENOENT; 542 543 for_each_available_child_of_node(dev->of_node, child) { 544 u32 idx; 545 546 ret = of_property_read_u32(child, "reg", &idx); 547 if (ret) { 548 dev_err(dev, "%pOF invalid 'reg' property", child); 549 continue; 550 } 551 552 if (idx >= cci->data->num_masters) { 553 dev_err(dev, "%pOF invalid 'reg' value: %u (max is %u)", 554 child, idx, cci->data->num_masters - 1); 555 continue; 556 } 557 558 cci->master[idx].adap.quirks = &cci->data->quirks; 559 cci->master[idx].adap.algo = &cci_algo; 560 cci->master[idx].adap.dev.parent = dev; 561 cci->master[idx].adap.dev.of_node = child; 562 cci->master[idx].master = idx; 563 cci->master[idx].cci = cci; 564 565 i2c_set_adapdata(&cci->master[idx].adap, &cci->master[idx]); 566 snprintf(cci->master[idx].adap.name, 567 sizeof(cci->master[idx].adap.name), "Qualcomm-CCI"); 568 569 cci->master[idx].mode = I2C_MODE_STANDARD; 570 ret = of_property_read_u32(child, "clock-frequency", &val); 571 if (!ret) { 572 if (val == 400000) 573 cci->master[idx].mode = I2C_MODE_FAST; 574 else if (val == 1000000) 575 cci->master[idx].mode = I2C_MODE_FAST_PLUS; 576 } 577 578 init_completion(&cci->master[idx].irq_complete); 579 } 580 581 /* Memory */ 582 583 r = platform_get_resource(pdev, IORESOURCE_MEM, 0); 584 cci->base = devm_ioremap_resource(dev, r); 585 if (IS_ERR(cci->base)) 586 return PTR_ERR(cci->base); 587 588 /* Clocks */ 589 590 ret = devm_clk_bulk_get_all(dev, &cci->clocks); 591 if (ret < 1) { 592 dev_err(dev, "failed to get clocks %d\n", ret); 593 return ret; 594 } 595 cci->nclocks = ret; 596 597 /* Retrieve CCI clock rate */ 598 for (i = 0; i < cci->nclocks; i++) { 599 if (!strcmp(cci->clocks[i].id, "cci")) { 600 cci_clk_rate = clk_get_rate(cci->clocks[i].clk); 601 break; 602 } 603 } 604 605 if (cci_clk_rate != cci->data->cci_clk_rate) { 606 /* cci clock set by the bootloader or via assigned clock rate 607 * in DT. 608 */ 609 dev_warn(dev, "Found %lu cci clk rate while %lu was expected\n", 610 cci_clk_rate, cci->data->cci_clk_rate); 611 } 612 613 ret = cci_enable_clocks(cci); 614 if (ret < 0) 615 return ret; 616 617 /* Interrupt */ 618 619 ret = platform_get_irq(pdev, 0); 620 if (ret < 0) 621 goto disable_clocks; 622 cci->irq = ret; 623 624 ret = devm_request_irq(dev, cci->irq, cci_isr, 0, dev_name(dev), cci); 625 if (ret < 0) { 626 dev_err(dev, "request_irq failed, ret: %d\n", ret); 627 goto disable_clocks; 628 } 629 630 val = readl(cci->base + CCI_HW_VERSION); 631 dev_dbg(dev, "CCI HW version = 0x%08x", val); 632 633 ret = cci_reset(cci); 634 if (ret < 0) 635 goto error; 636 637 ret = cci_init(cci); 638 if (ret < 0) 639 goto error; 640 641 for (i = 0; i < cci->data->num_masters; i++) { 642 if (!cci->master[i].cci) 643 continue; 644 645 ret = i2c_add_adapter(&cci->master[i].adap); 646 if (ret < 0) 647 goto error_i2c; 648 } 649 650 pm_runtime_set_autosuspend_delay(dev, MSEC_PER_SEC); 651 pm_runtime_use_autosuspend(dev); 652 pm_runtime_set_active(dev); 653 pm_runtime_enable(dev); 654 655 return 0; 656 657 error_i2c: 658 for (; i >= 0; i--) { 659 if (cci->master[i].cci) 660 i2c_del_adapter(&cci->master[i].adap); 661 } 662 error: 663 disable_irq(cci->irq); 664 disable_clocks: 665 cci_disable_clocks(cci); 666 667 return ret; 668 } 669 670 static int cci_remove(struct platform_device *pdev) 671 { 672 struct cci *cci = platform_get_drvdata(pdev); 673 int i; 674 675 for (i = 0; i < cci->data->num_masters; i++) { 676 if (cci->master[i].cci) 677 i2c_del_adapter(&cci->master[i].adap); 678 cci_halt(cci, i); 679 } 680 681 disable_irq(cci->irq); 682 pm_runtime_disable(&pdev->dev); 683 pm_runtime_set_suspended(&pdev->dev); 684 685 return 0; 686 } 687 688 static const struct cci_data cci_v1_data = { 689 .num_masters = 1, 690 .queue_size = { 64, 16 }, 691 .quirks = { 692 .max_write_len = 10, 693 .max_read_len = 12, 694 }, 695 .cci_clk_rate = 19200000, 696 .params[I2C_MODE_STANDARD] = { 697 .thigh = 78, 698 .tlow = 114, 699 .tsu_sto = 28, 700 .tsu_sta = 28, 701 .thd_dat = 10, 702 .thd_sta = 77, 703 .tbuf = 118, 704 .scl_stretch_en = 0, 705 .trdhld = 6, 706 .tsp = 1 707 }, 708 .params[I2C_MODE_FAST] = { 709 .thigh = 20, 710 .tlow = 28, 711 .tsu_sto = 21, 712 .tsu_sta = 21, 713 .thd_dat = 13, 714 .thd_sta = 18, 715 .tbuf = 32, 716 .scl_stretch_en = 0, 717 .trdhld = 6, 718 .tsp = 3 719 }, 720 }; 721 722 static const struct cci_data cci_v2_data = { 723 .num_masters = 2, 724 .queue_size = { 64, 16 }, 725 .quirks = { 726 .max_write_len = 11, 727 .max_read_len = 12, 728 }, 729 .cci_clk_rate = 37500000, 730 .params[I2C_MODE_STANDARD] = { 731 .thigh = 201, 732 .tlow = 174, 733 .tsu_sto = 204, 734 .tsu_sta = 231, 735 .thd_dat = 22, 736 .thd_sta = 162, 737 .tbuf = 227, 738 .scl_stretch_en = 0, 739 .trdhld = 6, 740 .tsp = 3 741 }, 742 .params[I2C_MODE_FAST] = { 743 .thigh = 38, 744 .tlow = 56, 745 .tsu_sto = 40, 746 .tsu_sta = 40, 747 .thd_dat = 22, 748 .thd_sta = 35, 749 .tbuf = 62, 750 .scl_stretch_en = 0, 751 .trdhld = 6, 752 .tsp = 3 753 }, 754 .params[I2C_MODE_FAST_PLUS] = { 755 .thigh = 16, 756 .tlow = 22, 757 .tsu_sto = 17, 758 .tsu_sta = 18, 759 .thd_dat = 16, 760 .thd_sta = 15, 761 .tbuf = 24, 762 .scl_stretch_en = 0, 763 .trdhld = 3, 764 .tsp = 3 765 }, 766 }; 767 768 static const struct of_device_id cci_dt_match[] = { 769 { .compatible = "qcom,msm8916-cci", .data = &cci_v1_data}, 770 { .compatible = "qcom,msm8996-cci", .data = &cci_v2_data}, 771 { .compatible = "qcom,sdm845-cci", .data = &cci_v2_data}, 772 {} 773 }; 774 MODULE_DEVICE_TABLE(of, cci_dt_match); 775 776 static struct platform_driver qcom_cci_driver = { 777 .probe = cci_probe, 778 .remove = cci_remove, 779 .driver = { 780 .name = "i2c-qcom-cci", 781 .of_match_table = cci_dt_match, 782 .pm = &qcom_cci_pm, 783 }, 784 }; 785 786 module_platform_driver(qcom_cci_driver); 787 788 MODULE_DESCRIPTION("Qualcomm Camera Control Interface driver"); 789 MODULE_AUTHOR("Todor Tomov <todor.tomov@linaro.org>"); 790 MODULE_AUTHOR("Loic Poulain <loic.poulain@linaro.org>"); 791 MODULE_LICENSE("GPL v2"); 792