forked from ~ljy/RK356X_SDK_RELEASE

hc
2024-05-10 37f49e37ab4cb5d0bc4c60eb5c6d4dd57db767bb
kernel/drivers/staging/iio/frequency/ad9832.c
....@@ -1,26 +1,28 @@
1
+// SPDX-License-Identifier: GPL-2.0
12 /*
23 * AD9832 SPI DDS driver
34 *
45 * Copyright 2011 Analog Devices Inc.
5
- *
6
- * Licensed under the GPL-2.
76 */
87
9
-#include <linux/device.h>
10
-#include <linux/kernel.h>
11
-#include <linux/slab.h>
12
-#include <linux/sysfs.h>
13
-#include <linux/spi/spi.h>
14
-#include <linux/regulator/consumer.h>
15
-#include <linux/err.h>
16
-#include <linux/module.h>
178 #include <asm/div64.h>
9
+
10
+#include <linux/clk.h>
11
+#include <linux/device.h>
12
+#include <linux/err.h>
13
+#include <linux/kernel.h>
14
+#include <linux/module.h>
15
+#include <linux/regulator/consumer.h>
16
+#include <linux/slab.h>
17
+#include <linux/spi/spi.h>
18
+#include <linux/sysfs.h>
1819
1920 #include <linux/iio/iio.h>
2021 #include <linux/iio/sysfs.h>
21
-#include "dds.h"
2222
2323 #include "ad9832.h"
24
+
25
+#include "dds.h"
2426
2527 /* Registers */
2628
....@@ -94,7 +96,7 @@
9496 struct spi_device *spi;
9597 struct regulator *avdd;
9698 struct regulator *dvdd;
97
- unsigned long mclk;
99
+ struct clk *mclk;
98100 unsigned short ctrl_fp;
99101 unsigned short ctrl_ss;
100102 unsigned short ctrl_src;
....@@ -129,10 +131,10 @@
129131 {
130132 unsigned long regval;
131133
132
- if (fout > (st->mclk / 2))
134
+ if (fout > (clk_get_rate(st->mclk) / 2))
133135 return -EINVAL;
134136
135
- regval = ad9832_calc_freqreg(st->mclk, fout);
137
+ regval = ad9832_calc_freqreg(clk_get_rate(st->mclk), fout);
136138
137139 st->freq_data[0] = cpu_to_be16((AD9832_CMD_FRE8BITSW << CMD_SHIFT) |
138140 (addr << ADD_SHIFT) |
....@@ -333,11 +335,19 @@
333335 goto error_disable_avdd;
334336 }
335337
336
- st->mclk = pdata->mclk;
338
+ st->mclk = devm_clk_get(&spi->dev, "mclk");
339
+ if (IS_ERR(st->mclk)) {
340
+ ret = PTR_ERR(st->mclk);
341
+ goto error_disable_dvdd;
342
+ }
343
+
344
+ ret = clk_prepare_enable(st->mclk);
345
+ if (ret < 0)
346
+ goto error_disable_dvdd;
347
+
337348 st->spi = spi;
338349 mutex_init(&st->lock);
339350
340
- indio_dev->dev.parent = &spi->dev;
341351 indio_dev->name = spi_get_device_id(spi)->name;
342352 indio_dev->info = &ad9832_info;
343353 indio_dev->modes = INDIO_DIRECT_MODE;
....@@ -384,39 +394,41 @@
384394 ret = spi_sync(st->spi, &st->msg);
385395 if (ret) {
386396 dev_err(&spi->dev, "device init failed\n");
387
- goto error_disable_dvdd;
397
+ goto error_unprepare_mclk;
388398 }
389399
390400 ret = ad9832_write_frequency(st, AD9832_FREQ0HM, pdata->freq0);
391401 if (ret)
392
- goto error_disable_dvdd;
402
+ goto error_unprepare_mclk;
393403
394404 ret = ad9832_write_frequency(st, AD9832_FREQ1HM, pdata->freq1);
395405 if (ret)
396
- goto error_disable_dvdd;
406
+ goto error_unprepare_mclk;
397407
398408 ret = ad9832_write_phase(st, AD9832_PHASE0H, pdata->phase0);
399409 if (ret)
400
- goto error_disable_dvdd;
410
+ goto error_unprepare_mclk;
401411
402412 ret = ad9832_write_phase(st, AD9832_PHASE1H, pdata->phase1);
403413 if (ret)
404
- goto error_disable_dvdd;
414
+ goto error_unprepare_mclk;
405415
406416 ret = ad9832_write_phase(st, AD9832_PHASE2H, pdata->phase2);
407417 if (ret)
408
- goto error_disable_dvdd;
418
+ goto error_unprepare_mclk;
409419
410420 ret = ad9832_write_phase(st, AD9832_PHASE3H, pdata->phase3);
411421 if (ret)
412
- goto error_disable_dvdd;
422
+ goto error_unprepare_mclk;
413423
414424 ret = iio_device_register(indio_dev);
415425 if (ret)
416
- goto error_disable_dvdd;
426
+ goto error_unprepare_mclk;
417427
418428 return 0;
419429
430
+error_unprepare_mclk:
431
+ clk_disable_unprepare(st->mclk);
420432 error_disable_dvdd:
421433 regulator_disable(st->dvdd);
422434 error_disable_avdd:
....@@ -431,6 +443,7 @@
431443 struct ad9832_state *st = iio_priv(indio_dev);
432444
433445 iio_device_unregister(indio_dev);
446
+ clk_disable_unprepare(st->mclk);
434447 regulator_disable(st->dvdd);
435448 regulator_disable(st->avdd);
436449
....@@ -454,6 +467,6 @@
454467 };
455468 module_spi_driver(ad9832_driver);
456469
457
-MODULE_AUTHOR("Michael Hennerich <hennerich@blackfin.uclinux.org>");
470
+MODULE_AUTHOR("Michael Hennerich <michael.hennerich@analog.com>");
458471 MODULE_DESCRIPTION("Analog Devices AD9832/AD9835 DDS");
459472 MODULE_LICENSE("GPL v2");