1 /* 2 * Renesas R-Car GyroADC driver 3 * 4 * Copyright 2016 Marek Vasut <marek.vasut@gmail.com> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation; either version 2 of the License, or 9 * (at your option) any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 */ 16 17 #include <linux/module.h> 18 #include <linux/platform_device.h> 19 #include <linux/delay.h> 20 #include <linux/kernel.h> 21 #include <linux/slab.h> 22 #include <linux/io.h> 23 #include <linux/clk.h> 24 #include <linux/of.h> 25 #include <linux/of_irq.h> 26 #include <linux/regulator/consumer.h> 27 #include <linux/of_platform.h> 28 #include <linux/err.h> 29 #include <linux/pm_runtime.h> 30 31 #include <linux/iio/iio.h> 32 #include <linux/iio/sysfs.h> 33 #include <linux/iio/trigger.h> 34 35 #define DRIVER_NAME "rcar-gyroadc" 36 37 /* GyroADC registers. */ 38 #define RCAR_GYROADC_MODE_SELECT 0x00 39 #define RCAR_GYROADC_MODE_SELECT_1_MB88101A 0x0 40 #define RCAR_GYROADC_MODE_SELECT_2_ADCS7476 0x1 41 #define RCAR_GYROADC_MODE_SELECT_3_MAX1162 0x3 42 43 #define RCAR_GYROADC_START_STOP 0x04 44 #define RCAR_GYROADC_START_STOP_START BIT(0) 45 46 #define RCAR_GYROADC_CLOCK_LENGTH 0x08 47 #define RCAR_GYROADC_1_25MS_LENGTH 0x0c 48 49 #define RCAR_GYROADC_REALTIME_DATA(ch) (0x10 + ((ch) * 4)) 50 #define RCAR_GYROADC_100MS_ADDED_DATA(ch) (0x30 + ((ch) * 4)) 51 #define RCAR_GYROADC_10MS_AVG_DATA(ch) (0x50 + ((ch) * 4)) 52 53 #define RCAR_GYROADC_FIFO_STATUS 0x70 54 #define RCAR_GYROADC_FIFO_STATUS_EMPTY(ch) BIT(0 + (4 * (ch))) 55 #define RCAR_GYROADC_FIFO_STATUS_FULL(ch) BIT(1 + (4 * (ch))) 56 #define RCAR_GYROADC_FIFO_STATUS_ERROR(ch) BIT(2 + (4 * (ch))) 57 58 #define RCAR_GYROADC_INTR 0x74 59 #define RCAR_GYROADC_INTR_INT BIT(0) 60 61 #define RCAR_GYROADC_INTENR 0x78 62 #define RCAR_GYROADC_INTENR_INTEN BIT(0) 63 64 #define RCAR_GYROADC_SAMPLE_RATE 800 /* Hz */ 65 66 #define RCAR_GYROADC_RUNTIME_PM_DELAY_MS 2000 67 68 enum rcar_gyroadc_model { 69 RCAR_GYROADC_MODEL_DEFAULT, 70 RCAR_GYROADC_MODEL_R8A7792, 71 }; 72 73 struct rcar_gyroadc { 74 struct device *dev; 75 void __iomem *regs; 76 struct clk *iclk; 77 struct regulator *vref[8]; 78 unsigned int num_channels; 79 enum rcar_gyroadc_model model; 80 unsigned int mode; 81 unsigned int sample_width; 82 }; 83 84 static void rcar_gyroadc_hw_init(struct rcar_gyroadc *priv) 85 { 86 const unsigned long clk_mhz = clk_get_rate(priv->iclk) / 1000000; 87 const unsigned long clk_mul = 88 (priv->mode == RCAR_GYROADC_MODE_SELECT_1_MB88101A) ? 10 : 5; 89 unsigned long clk_len = clk_mhz * clk_mul; 90 91 /* 92 * According to the R-Car Gen2 datasheet Rev. 1.01, Sept 08 2014, 93 * page 77-7, clock length must be even number. If it's odd number, 94 * add one. 95 */ 96 if (clk_len & 1) 97 clk_len++; 98 99 /* Stop the GyroADC. */ 100 writel(0, priv->regs + RCAR_GYROADC_START_STOP); 101 102 /* Disable IRQ on V2H. */ 103 if (priv->model == RCAR_GYROADC_MODEL_R8A7792) 104 writel(0, priv->regs + RCAR_GYROADC_INTENR); 105 106 /* Set mode and timing. */ 107 writel(priv->mode, priv->regs + RCAR_GYROADC_MODE_SELECT); 108 writel(clk_len, priv->regs + RCAR_GYROADC_CLOCK_LENGTH); 109 writel(clk_mhz * 1250, priv->regs + RCAR_GYROADC_1_25MS_LENGTH); 110 } 111 112 static void rcar_gyroadc_hw_start(struct rcar_gyroadc *priv) 113 { 114 /* Start sampling. */ 115 writel(RCAR_GYROADC_START_STOP_START, 116 priv->regs + RCAR_GYROADC_START_STOP); 117 118 /* 119 * Wait for the first conversion to complete. This is longer than 120 * the 1.25 mS in the datasheet because 1.25 mS is not enough for 121 * the hardware to deliver the first sample and the hardware does 122 * then return zeroes instead of valid data. 123 */ 124 mdelay(3); 125 } 126 127 static void rcar_gyroadc_hw_stop(struct rcar_gyroadc *priv) 128 { 129 /* Stop the GyroADC. */ 130 writel(0, priv->regs + RCAR_GYROADC_START_STOP); 131 } 132 133 #define RCAR_GYROADC_CHAN(_idx) { \ 134 .type = IIO_VOLTAGE, \ 135 .indexed = 1, \ 136 .channel = (_idx), \ 137 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ 138 BIT(IIO_CHAN_INFO_SCALE), \ 139 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SAMP_FREQ), \ 140 } 141 142 static const struct iio_chan_spec rcar_gyroadc_iio_channels_1[] = { 143 RCAR_GYROADC_CHAN(0), 144 RCAR_GYROADC_CHAN(1), 145 RCAR_GYROADC_CHAN(2), 146 RCAR_GYROADC_CHAN(3), 147 }; 148 149 static const struct iio_chan_spec rcar_gyroadc_iio_channels_2[] = { 150 RCAR_GYROADC_CHAN(0), 151 RCAR_GYROADC_CHAN(1), 152 RCAR_GYROADC_CHAN(2), 153 RCAR_GYROADC_CHAN(3), 154 RCAR_GYROADC_CHAN(4), 155 RCAR_GYROADC_CHAN(5), 156 RCAR_GYROADC_CHAN(6), 157 RCAR_GYROADC_CHAN(7), 158 }; 159 160 static const struct iio_chan_spec rcar_gyroadc_iio_channels_3[] = { 161 RCAR_GYROADC_CHAN(0), 162 RCAR_GYROADC_CHAN(1), 163 RCAR_GYROADC_CHAN(2), 164 RCAR_GYROADC_CHAN(3), 165 RCAR_GYROADC_CHAN(4), 166 RCAR_GYROADC_CHAN(5), 167 RCAR_GYROADC_CHAN(6), 168 RCAR_GYROADC_CHAN(7), 169 }; 170 171 static int rcar_gyroadc_set_power(struct rcar_gyroadc *priv, bool on) 172 { 173 struct device *dev = priv->dev; 174 int ret; 175 176 if (on) { 177 ret = pm_runtime_get_sync(dev); 178 if (ret < 0) 179 pm_runtime_put_noidle(dev); 180 } else { 181 pm_runtime_mark_last_busy(dev); 182 ret = pm_runtime_put_autosuspend(dev); 183 } 184 185 return ret; 186 } 187 188 static int rcar_gyroadc_read_raw(struct iio_dev *indio_dev, 189 struct iio_chan_spec const *chan, 190 int *val, int *val2, long mask) 191 { 192 struct rcar_gyroadc *priv = iio_priv(indio_dev); 193 struct regulator *consumer; 194 unsigned int datareg = RCAR_GYROADC_REALTIME_DATA(chan->channel); 195 unsigned int vref; 196 int ret; 197 198 /* 199 * MB88101 is special in that it has only single regulator for 200 * all four channels. 201 */ 202 if (priv->mode == RCAR_GYROADC_MODE_SELECT_1_MB88101A) 203 consumer = priv->vref[0]; 204 else 205 consumer = priv->vref[chan->channel]; 206 207 switch (mask) { 208 case IIO_CHAN_INFO_RAW: 209 if (chan->type != IIO_VOLTAGE) 210 return -EINVAL; 211 212 /* Channel not connected. */ 213 if (!consumer) 214 return -EINVAL; 215 216 ret = iio_device_claim_direct_mode(indio_dev); 217 if (ret) 218 return ret; 219 220 ret = rcar_gyroadc_set_power(priv, true); 221 if (ret < 0) { 222 iio_device_release_direct_mode(indio_dev); 223 return ret; 224 } 225 226 *val = readl(priv->regs + datareg); 227 *val &= BIT(priv->sample_width) - 1; 228 229 ret = rcar_gyroadc_set_power(priv, false); 230 iio_device_release_direct_mode(indio_dev); 231 if (ret < 0) 232 return ret; 233 234 return IIO_VAL_INT; 235 case IIO_CHAN_INFO_SCALE: 236 /* Channel not connected. */ 237 if (!consumer) 238 return -EINVAL; 239 240 vref = regulator_get_voltage(consumer); 241 *val = vref / 1000; 242 *val2 = 1 << priv->sample_width; 243 244 return IIO_VAL_FRACTIONAL; 245 case IIO_CHAN_INFO_SAMP_FREQ: 246 *val = RCAR_GYROADC_SAMPLE_RATE; 247 248 return IIO_VAL_INT; 249 default: 250 return -EINVAL; 251 } 252 } 253 254 static int rcar_gyroadc_reg_access(struct iio_dev *indio_dev, 255 unsigned int reg, unsigned int writeval, 256 unsigned int *readval) 257 { 258 struct rcar_gyroadc *priv = iio_priv(indio_dev); 259 unsigned int maxreg = RCAR_GYROADC_FIFO_STATUS; 260 261 if (readval == NULL) 262 return -EINVAL; 263 264 if (reg % 4) 265 return -EINVAL; 266 267 /* Handle the V2H case with extra interrupt block. */ 268 if (priv->model == RCAR_GYROADC_MODEL_R8A7792) 269 maxreg = RCAR_GYROADC_INTENR; 270 271 if (reg > maxreg) 272 return -EINVAL; 273 274 *readval = readl(priv->regs + reg); 275 276 return 0; 277 } 278 279 static const struct iio_info rcar_gyroadc_iio_info = { 280 .driver_module = THIS_MODULE, 281 .read_raw = rcar_gyroadc_read_raw, 282 .debugfs_reg_access = rcar_gyroadc_reg_access, 283 }; 284 285 static const struct of_device_id rcar_gyroadc_match[] = { 286 { 287 /* R-Car compatible GyroADC */ 288 .compatible = "renesas,rcar-gyroadc", 289 .data = (void *)RCAR_GYROADC_MODEL_DEFAULT, 290 }, { 291 /* R-Car V2H specialty with interrupt registers. */ 292 .compatible = "renesas,r8a7792-gyroadc", 293 .data = (void *)RCAR_GYROADC_MODEL_R8A7792, 294 }, { 295 /* sentinel */ 296 } 297 }; 298 299 MODULE_DEVICE_TABLE(of, rcar_gyroadc_match); 300 301 static const struct of_device_id rcar_gyroadc_child_match[] = { 302 /* Mode 1 ADCs */ 303 { 304 .compatible = "fujitsu,mb88101a", 305 .data = (void *)RCAR_GYROADC_MODE_SELECT_1_MB88101A, 306 }, 307 /* Mode 2 ADCs */ 308 { 309 .compatible = "ti,adcs7476", 310 .data = (void *)RCAR_GYROADC_MODE_SELECT_2_ADCS7476, 311 }, { 312 .compatible = "ti,adc121", 313 .data = (void *)RCAR_GYROADC_MODE_SELECT_2_ADCS7476, 314 }, { 315 .compatible = "adi,ad7476", 316 .data = (void *)RCAR_GYROADC_MODE_SELECT_2_ADCS7476, 317 }, 318 /* Mode 3 ADCs */ 319 { 320 .compatible = "maxim,max1162", 321 .data = (void *)RCAR_GYROADC_MODE_SELECT_3_MAX1162, 322 }, { 323 .compatible = "maxim,max11100", 324 .data = (void *)RCAR_GYROADC_MODE_SELECT_3_MAX1162, 325 }, 326 { /* sentinel */ } 327 }; 328 329 static int rcar_gyroadc_parse_subdevs(struct iio_dev *indio_dev) 330 { 331 const struct of_device_id *of_id; 332 const struct iio_chan_spec *channels; 333 struct rcar_gyroadc *priv = iio_priv(indio_dev); 334 struct device *dev = priv->dev; 335 struct device_node *np = dev->of_node; 336 struct device_node *child; 337 struct regulator *vref; 338 unsigned int reg; 339 unsigned int adcmode, childmode; 340 unsigned int sample_width; 341 unsigned int num_channels; 342 int ret, first = 1; 343 344 for_each_child_of_node(np, child) { 345 of_id = of_match_node(rcar_gyroadc_child_match, child); 346 if (!of_id) { 347 dev_err(dev, "Ignoring unsupported ADC \"%s\".", 348 child->name); 349 continue; 350 } 351 352 childmode = (unsigned int)of_id->data; 353 switch (childmode) { 354 case RCAR_GYROADC_MODE_SELECT_1_MB88101A: 355 sample_width = 12; 356 channels = rcar_gyroadc_iio_channels_1; 357 num_channels = ARRAY_SIZE(rcar_gyroadc_iio_channels_1); 358 break; 359 case RCAR_GYROADC_MODE_SELECT_2_ADCS7476: 360 sample_width = 15; 361 channels = rcar_gyroadc_iio_channels_2; 362 num_channels = ARRAY_SIZE(rcar_gyroadc_iio_channels_2); 363 break; 364 case RCAR_GYROADC_MODE_SELECT_3_MAX1162: 365 sample_width = 16; 366 channels = rcar_gyroadc_iio_channels_3; 367 num_channels = ARRAY_SIZE(rcar_gyroadc_iio_channels_3); 368 break; 369 } 370 371 /* 372 * MB88101 is special in that it's only a single chip taking 373 * up all the CHS lines. Thus, the DT binding is also special 374 * and has no reg property. If we run into such ADC, handle 375 * it here. 376 */ 377 if (childmode == RCAR_GYROADC_MODE_SELECT_1_MB88101A) { 378 reg = 0; 379 } else { 380 ret = of_property_read_u32(child, "reg", ®); 381 if (ret) { 382 dev_err(dev, 383 "Failed to get child reg property of ADC \"%s\".\n", 384 child->name); 385 return ret; 386 } 387 388 /* Channel number is too high. */ 389 if (reg >= num_channels) { 390 dev_err(dev, 391 "Only %i channels supported with %s, but reg = <%i>.\n", 392 num_channels, child->name, reg); 393 return ret; 394 } 395 } 396 397 /* Child node selected different mode than the rest. */ 398 if (!first && (adcmode != childmode)) { 399 dev_err(dev, 400 "Channel %i uses different ADC mode than the rest.\n", 401 reg); 402 return ret; 403 } 404 405 /* Channel is valid, grab the regulator. */ 406 dev->of_node = child; 407 vref = devm_regulator_get(dev, "vref"); 408 dev->of_node = np; 409 if (IS_ERR(vref)) { 410 dev_dbg(dev, "Channel %i 'vref' supply not connected.\n", 411 reg); 412 return PTR_ERR(vref); 413 } 414 415 priv->vref[reg] = vref; 416 417 if (!first) 418 continue; 419 420 /* First child node which passed sanity tests. */ 421 adcmode = childmode; 422 first = 0; 423 424 priv->num_channels = num_channels; 425 priv->mode = childmode; 426 priv->sample_width = sample_width; 427 428 indio_dev->channels = channels; 429 indio_dev->num_channels = num_channels; 430 431 /* 432 * MB88101 is special and we only have one such device 433 * attached to the GyroADC at a time, so if we found it, 434 * we can stop parsing here. 435 */ 436 if (childmode == RCAR_GYROADC_MODE_SELECT_1_MB88101A) 437 break; 438 } 439 440 if (first) { 441 dev_err(dev, "No valid ADC channels found, aborting.\n"); 442 return -EINVAL; 443 } 444 445 return 0; 446 } 447 448 static void rcar_gyroadc_deinit_supplies(struct iio_dev *indio_dev) 449 { 450 struct rcar_gyroadc *priv = iio_priv(indio_dev); 451 unsigned int i; 452 453 for (i = 0; i < priv->num_channels; i++) { 454 if (!priv->vref[i]) 455 continue; 456 457 regulator_disable(priv->vref[i]); 458 } 459 } 460 461 static int rcar_gyroadc_init_supplies(struct iio_dev *indio_dev) 462 { 463 struct rcar_gyroadc *priv = iio_priv(indio_dev); 464 struct device *dev = priv->dev; 465 unsigned int i; 466 int ret; 467 468 for (i = 0; i < priv->num_channels; i++) { 469 if (!priv->vref[i]) 470 continue; 471 472 ret = regulator_enable(priv->vref[i]); 473 if (ret) { 474 dev_err(dev, "Failed to enable regulator %i (ret=%i)\n", 475 i, ret); 476 goto err; 477 } 478 } 479 480 return 0; 481 482 err: 483 rcar_gyroadc_deinit_supplies(indio_dev); 484 return ret; 485 } 486 487 static int rcar_gyroadc_probe(struct platform_device *pdev) 488 { 489 const struct of_device_id *of_id = 490 of_match_device(rcar_gyroadc_match, &pdev->dev); 491 struct device *dev = &pdev->dev; 492 struct rcar_gyroadc *priv; 493 struct iio_dev *indio_dev; 494 struct resource *mem; 495 int ret; 496 497 indio_dev = devm_iio_device_alloc(dev, sizeof(*priv)); 498 if (!indio_dev) { 499 dev_err(dev, "Failed to allocate IIO device.\n"); 500 return -ENOMEM; 501 } 502 503 priv = iio_priv(indio_dev); 504 priv->dev = dev; 505 506 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0); 507 priv->regs = devm_ioremap_resource(dev, mem); 508 if (IS_ERR(priv->regs)) 509 return PTR_ERR(priv->regs); 510 511 priv->iclk = devm_clk_get(dev, "if"); 512 if (IS_ERR(priv->iclk)) { 513 ret = PTR_ERR(priv->iclk); 514 if (ret != -EPROBE_DEFER) 515 dev_err(dev, "Failed to get IF clock (ret=%i)\n", ret); 516 return ret; 517 } 518 519 ret = rcar_gyroadc_parse_subdevs(indio_dev); 520 if (ret) 521 return ret; 522 523 ret = rcar_gyroadc_init_supplies(indio_dev); 524 if (ret) 525 return ret; 526 527 priv->model = (enum rcar_gyroadc_model)of_id->data; 528 529 platform_set_drvdata(pdev, indio_dev); 530 531 indio_dev->name = DRIVER_NAME; 532 indio_dev->dev.parent = dev; 533 indio_dev->dev.of_node = pdev->dev.of_node; 534 indio_dev->info = &rcar_gyroadc_iio_info; 535 indio_dev->modes = INDIO_DIRECT_MODE; 536 537 ret = clk_prepare_enable(priv->iclk); 538 if (ret) { 539 dev_err(dev, "Could not prepare or enable the IF clock.\n"); 540 goto err_clk_if_enable; 541 } 542 543 pm_runtime_set_autosuspend_delay(dev, RCAR_GYROADC_RUNTIME_PM_DELAY_MS); 544 pm_runtime_use_autosuspend(dev); 545 pm_runtime_enable(dev); 546 547 pm_runtime_get_sync(dev); 548 rcar_gyroadc_hw_init(priv); 549 rcar_gyroadc_hw_start(priv); 550 551 ret = iio_device_register(indio_dev); 552 if (ret) { 553 dev_err(dev, "Couldn't register IIO device.\n"); 554 goto err_iio_device_register; 555 } 556 557 pm_runtime_put_sync(dev); 558 559 return 0; 560 561 err_iio_device_register: 562 rcar_gyroadc_hw_stop(priv); 563 pm_runtime_put_sync(dev); 564 pm_runtime_disable(dev); 565 pm_runtime_set_suspended(dev); 566 clk_disable_unprepare(priv->iclk); 567 err_clk_if_enable: 568 rcar_gyroadc_deinit_supplies(indio_dev); 569 570 return ret; 571 } 572 573 static int rcar_gyroadc_remove(struct platform_device *pdev) 574 { 575 struct iio_dev *indio_dev = platform_get_drvdata(pdev); 576 struct rcar_gyroadc *priv = iio_priv(indio_dev); 577 struct device *dev = priv->dev; 578 579 iio_device_unregister(indio_dev); 580 pm_runtime_get_sync(dev); 581 rcar_gyroadc_hw_stop(priv); 582 pm_runtime_put_sync(dev); 583 pm_runtime_disable(dev); 584 pm_runtime_set_suspended(dev); 585 clk_disable_unprepare(priv->iclk); 586 rcar_gyroadc_deinit_supplies(indio_dev); 587 588 return 0; 589 } 590 591 #if defined(CONFIG_PM) 592 static int rcar_gyroadc_suspend(struct device *dev) 593 { 594 struct iio_dev *indio_dev = dev_get_drvdata(dev); 595 struct rcar_gyroadc *priv = iio_priv(indio_dev); 596 597 rcar_gyroadc_hw_stop(priv); 598 599 return 0; 600 } 601 602 static int rcar_gyroadc_resume(struct device *dev) 603 { 604 struct iio_dev *indio_dev = dev_get_drvdata(dev); 605 struct rcar_gyroadc *priv = iio_priv(indio_dev); 606 607 rcar_gyroadc_hw_start(priv); 608 609 return 0; 610 } 611 #endif 612 613 static const struct dev_pm_ops rcar_gyroadc_pm_ops = { 614 SET_RUNTIME_PM_OPS(rcar_gyroadc_suspend, rcar_gyroadc_resume, NULL) 615 }; 616 617 static struct platform_driver rcar_gyroadc_driver = { 618 .probe = rcar_gyroadc_probe, 619 .remove = rcar_gyroadc_remove, 620 .driver = { 621 .name = DRIVER_NAME, 622 .of_match_table = rcar_gyroadc_match, 623 .pm = &rcar_gyroadc_pm_ops, 624 }, 625 }; 626 627 module_platform_driver(rcar_gyroadc_driver); 628 629 MODULE_AUTHOR("Marek Vasut <marek.vasut@gmail.com>"); 630 MODULE_DESCRIPTION("Renesas R-Car GyroADC driver"); 631 MODULE_LICENSE("GPL"); 632