2 * TWL6040 clock module driver for OMAP4 McPDM functional clock
4 * Copyright (C) 2012 Texas Instruments Inc.
5 * Peter Ujfalusi <peter.ujfalusi@ti.com>
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU General Public License
9 * version 2 as published by the Free Software Foundation.
11 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 * General Public License for more details.
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA
23 #include <linux/clk.h>
24 #include <linux/module.h>
25 #include <linux/slab.h>
26 #include <linux/platform_device.h>
27 #include <linux/mfd/twl6040.h>
28 #include <linux/clk-provider.h>
31 struct twl6040
*twl6040
;
33 struct clk_hw mcpdm_fclk
;
38 static int twl6040_bitclk_is_enabled(struct clk_hw
*hw
)
40 struct twl6040_clk
*twl6040_clk
= container_of(hw
, struct twl6040_clk
,
42 return twl6040_clk
->enabled
;
45 static int twl6040_bitclk_prepare(struct clk_hw
*hw
)
47 struct twl6040_clk
*twl6040_clk
= container_of(hw
, struct twl6040_clk
,
51 ret
= twl6040_power(twl6040_clk
->twl6040
, 1);
53 twl6040_clk
->enabled
= 1;
58 static void twl6040_bitclk_unprepare(struct clk_hw
*hw
)
60 struct twl6040_clk
*twl6040_clk
= container_of(hw
, struct twl6040_clk
,
64 ret
= twl6040_power(twl6040_clk
->twl6040
, 0);
66 twl6040_clk
->enabled
= 0;
69 static const struct clk_ops twl6040_mcpdm_ops
= {
70 .is_enabled
= twl6040_bitclk_is_enabled
,
71 .prepare
= twl6040_bitclk_prepare
,
72 .unprepare
= twl6040_bitclk_unprepare
,
75 static struct clk_init_data wm831x_clkout_init
= {
77 .ops
= &twl6040_mcpdm_ops
,
81 static int twl6040_clk_probe(struct platform_device
*pdev
)
83 struct twl6040
*twl6040
= dev_get_drvdata(pdev
->dev
.parent
);
84 struct twl6040_clk
*clkdata
;
86 clkdata
= devm_kzalloc(&pdev
->dev
, sizeof(*clkdata
), GFP_KERNEL
);
90 clkdata
->dev
= &pdev
->dev
;
91 clkdata
->twl6040
= twl6040
;
93 clkdata
->mcpdm_fclk
.init
= &wm831x_clkout_init
;
94 clkdata
->clk
= clk_register(&pdev
->dev
, &clkdata
->mcpdm_fclk
);
95 if (IS_ERR(clkdata
->clk
))
96 return PTR_ERR(clkdata
->clk
);
98 platform_set_drvdata(pdev
, clkdata
);
103 static int twl6040_clk_remove(struct platform_device
*pdev
)
105 struct twl6040_clk
*clkdata
= platform_get_drvdata(pdev
);
107 clk_unregister(clkdata
->clk
);
112 static struct platform_driver twl6040_clk_driver
= {
114 .name
= "twl6040-clk",
116 .probe
= twl6040_clk_probe
,
117 .remove
= twl6040_clk_remove
,
120 module_platform_driver(twl6040_clk_driver
);
122 MODULE_DESCRIPTION("TWL6040 clock driver for McPDM functional clock");
123 MODULE_AUTHOR("Peter Ujfalusi <peter.ujfalusi@ti.com>");
124 MODULE_ALIAS("platform:twl6040-clk");
125 MODULE_LICENSE("GPL");