blob: 6da06341f6c909312afea387e875fe82cc1592b8 [file] [log] [blame]
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +01001/*
2 * Anatop MFD driver
3 *
4 * Copyright (C) 2012 Ying-Chun Liu (PaulLiu) <paul.liu@linaro.org>
5 * Copyright (C) 2012 Linaro
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 * This program is free software; you can redistribute it and/or modify
21 * it under the terms of the GNU General Public License as published by
22 * the Free Software Foundation; either version 2 of the License, or
23 * (at your option) any later version.
24 *
25 * This program is distributed in the hope that it will be useful,
26 * but WITHOUT ANY WARRANTY; without even the implied warranty of
27 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
28 * GNU General Public License for more details.
29 *
30 * You should have received a copy of the GNU General Public License along
31 * with this program; if not, write to the Free Software Foundation, Inc.,
32 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
33 *
34 */
35
36#include <linux/io.h>
37#include <linux/module.h>
38#include <linux/platform_device.h>
39#include <linux/of.h>
40#include <linux/of_platform.h>
41#include <linux/of_address.h>
42#include <linux/mfd/anatop.h>
43
Richard Zhaob09530e2012-05-13 09:18:02 +080044u32 anatop_read_reg(struct anatop *adata, u32 addr)
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010045{
Richard Zhaob09530e2012-05-13 09:18:02 +080046 return readl(adata->ioreg + addr);
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010047}
Richard Zhaob09530e2012-05-13 09:18:02 +080048EXPORT_SYMBOL_GPL(anatop_read_reg);
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010049
Richard Zhaob09530e2012-05-13 09:18:02 +080050void anatop_write_reg(struct anatop *adata, u32 addr, u32 data, u32 mask)
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010051{
Richard Zhaob09530e2012-05-13 09:18:02 +080052 u32 val;
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010053
Richard Zhaob09530e2012-05-13 09:18:02 +080054 data &= mask;
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010055
56 spin_lock(&adata->reglock);
Richard Zhaob09530e2012-05-13 09:18:02 +080057 val = readl(adata->ioreg + addr);
58 val &= ~mask;
59 val |= data;
60 writel(val, adata->ioreg + addr);
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010061 spin_unlock(&adata->reglock);
62}
Richard Zhaob09530e2012-05-13 09:18:02 +080063EXPORT_SYMBOL_GPL(anatop_write_reg);
Ying-Chun Liu (PaulLiu)75060a12012-03-16 21:12:32 +010064
65static const struct of_device_id of_anatop_match[] = {
66 { .compatible = "fsl,imx6q-anatop", },
67 { },
68};
69
70static int __devinit of_anatop_probe(struct platform_device *pdev)
71{
72 struct device *dev = &pdev->dev;
73 struct device_node *np = dev->of_node;
74 void *ioreg;
75 struct anatop *drvdata;
76
77 ioreg = of_iomap(np, 0);
78 if (!ioreg)
79 return -EADDRNOTAVAIL;
80 drvdata = devm_kzalloc(dev, sizeof(*drvdata), GFP_KERNEL);
81 if (!drvdata)
82 return -ENOMEM;
83 drvdata->ioreg = ioreg;
84 spin_lock_init(&drvdata->reglock);
85 platform_set_drvdata(pdev, drvdata);
86 of_platform_populate(np, of_anatop_match, NULL, dev);
87
88 return 0;
89}
90
91static int __devexit of_anatop_remove(struct platform_device *pdev)
92{
93 struct anatop *drvdata;
94 drvdata = platform_get_drvdata(pdev);
95 iounmap(drvdata->ioreg);
96
97 return 0;
98}
99
100static struct platform_driver anatop_of_driver = {
101 .driver = {
102 .name = "anatop-mfd",
103 .owner = THIS_MODULE,
104 .of_match_table = of_anatop_match,
105 },
106 .probe = of_anatop_probe,
107 .remove = of_anatop_remove,
108};
109
110static int __init anatop_init(void)
111{
112 return platform_driver_register(&anatop_of_driver);
113}
114postcore_initcall(anatop_init);
115
116static void __exit anatop_exit(void)
117{
118 platform_driver_unregister(&anatop_of_driver);
119}
120module_exit(anatop_exit);
121
122MODULE_AUTHOR("Ying-Chun Liu (PaulLiu) <paul.liu@linaro.org>");
123MODULE_DESCRIPTION("ANATOP MFD driver");
124MODULE_LICENSE("GPL v2");