diff options
author | Konrad Rzeszutek Wilk <konrad.wilk@oracle.com> | 2012-09-12 11:14:33 -0400 |
---|---|---|
committer | Konrad Rzeszutek Wilk <konrad.wilk@oracle.com> | 2012-09-12 11:14:33 -0400 |
commit | 25a765b7f05cb8460fa01b54568894b20e184862 (patch) | |
tree | 0b56db57b4d9f912393ab303c269e0fe6cdf8635 /drivers/pwm/pwm-bfin.c | |
parent | 9d2be9287107695708e6aae5105a8a518a6cb4d0 (diff) | |
parent | 64282278989d5b0398dcb3ba7904cb00c621dc35 (diff) |
Merge branch 'x86/platform' of git://git.kernel.org/pub/scm/linux/kernel/git/tip/tip into stable/for-linus-3.7
* 'x86/platform' of git://git.kernel.org/pub/scm/linux/kernel/git/tip/tip: (9690 commits)
x86: Document x86_init.paging.pagetable_init()
x86: xen: Cleanup and remove x86_init.paging.pagetable_setup_done()
x86: Move paging_init() call to x86_init.paging.pagetable_init()
x86: Rename pagetable_setup_start() to pagetable_init()
x86: Remove base argument from x86_init.paging.pagetable_setup_start
Linux 3.6-rc5
HID: tpkbd: work even if the new Lenovo Keyboard driver is not configured
Remove user-triggerable BUG from mpol_to_str
xen/pciback: Fix proper FLR steps.
uml: fix compile error in deliver_alarm()
dj: memory scribble in logi_dj
Fix order of arguments to compat_put_time[spec|val]
xen: Use correct masking in xen_swiotlb_alloc_coherent.
xen: fix logical error in tlb flushing
xen/p2m: Fix one-off error in checking the P2M tree directory.
powerpc: Don't use __put_user() in patch_instruction
powerpc: Make sure IPI handlers see data written by IPI senders
powerpc: Restore correct DSCR in context switch
powerpc: Fix DSCR inheritance in copy_thread()
powerpc: Keep thread.dscr and thread.dscr_inherit in sync
...
Diffstat (limited to 'drivers/pwm/pwm-bfin.c')
-rw-r--r-- | drivers/pwm/pwm-bfin.c | 162 |
1 files changed, 162 insertions, 0 deletions
diff --git a/drivers/pwm/pwm-bfin.c b/drivers/pwm/pwm-bfin.c new file mode 100644 index 000000000000..d53c4e7941ef --- /dev/null +++ b/drivers/pwm/pwm-bfin.c | |||
@@ -0,0 +1,162 @@ | |||
1 | /* | ||
2 | * Blackfin Pulse Width Modulation (PWM) core | ||
3 | * | ||
4 | * Copyright (c) 2011 Analog Devices Inc. | ||
5 | * | ||
6 | * Licensed under the GPL-2 or later. | ||
7 | */ | ||
8 | |||
9 | #include <linux/module.h> | ||
10 | #include <linux/platform_device.h> | ||
11 | #include <linux/pwm.h> | ||
12 | #include <linux/slab.h> | ||
13 | |||
14 | #include <asm/gptimers.h> | ||
15 | #include <asm/portmux.h> | ||
16 | |||
17 | struct bfin_pwm_chip { | ||
18 | struct pwm_chip chip; | ||
19 | }; | ||
20 | |||
21 | struct bfin_pwm { | ||
22 | unsigned short pin; | ||
23 | }; | ||
24 | |||
25 | static const unsigned short pwm_to_gptimer_per[] = { | ||
26 | P_TMR0, P_TMR1, P_TMR2, P_TMR3, P_TMR4, P_TMR5, | ||
27 | P_TMR6, P_TMR7, P_TMR8, P_TMR9, P_TMR10, P_TMR11, | ||
28 | }; | ||
29 | |||
30 | static int bfin_pwm_request(struct pwm_chip *chip, struct pwm_device *pwm) | ||
31 | { | ||
32 | struct bfin_pwm *priv; | ||
33 | int ret; | ||
34 | |||
35 | if (pwm->hwpwm >= ARRAY_SIZE(pwm_to_gptimer_per)) | ||
36 | return -EINVAL; | ||
37 | |||
38 | priv = kzalloc(sizeof(*priv), GFP_KERNEL); | ||
39 | if (!priv) | ||
40 | return -ENOMEM; | ||
41 | |||
42 | priv->pin = pwm_to_gptimer_per[pwm->hwpwm]; | ||
43 | |||
44 | ret = peripheral_request(priv->pin, NULL); | ||
45 | if (ret) { | ||
46 | kfree(priv); | ||
47 | return ret; | ||
48 | } | ||
49 | |||
50 | pwm_set_chip_data(pwm, priv); | ||
51 | |||
52 | return 0; | ||
53 | } | ||
54 | |||
55 | static void bfin_pwm_free(struct pwm_chip *chip, struct pwm_device *pwm) | ||
56 | { | ||
57 | struct bfin_pwm *priv = pwm_get_chip_data(pwm); | ||
58 | |||
59 | if (priv) { | ||
60 | peripheral_free(priv->pin); | ||
61 | kfree(priv); | ||
62 | } | ||
63 | } | ||
64 | |||
65 | static int bfin_pwm_config(struct pwm_chip *chip, struct pwm_device *pwm, | ||
66 | int duty_ns, int period_ns) | ||
67 | { | ||
68 | struct bfin_pwm *priv = pwm_get_chip_data(pwm); | ||
69 | unsigned long period, duty; | ||
70 | unsigned long long val; | ||
71 | |||
72 | if (duty_ns < 0 || duty_ns > period_ns) | ||
73 | return -EINVAL; | ||
74 | |||
75 | val = (unsigned long long)get_sclk() * period_ns; | ||
76 | do_div(val, NSEC_PER_SEC); | ||
77 | period = val; | ||
78 | |||
79 | val = (unsigned long long)period * duty_ns; | ||
80 | do_div(val, period_ns); | ||
81 | duty = period - val; | ||
82 | |||
83 | if (duty >= period) | ||
84 | duty = period - 1; | ||
85 | |||
86 | set_gptimer_config(priv->pin, TIMER_MODE_PWM | TIMER_PERIOD_CNT); | ||
87 | set_gptimer_pwidth(priv->pin, duty); | ||
88 | set_gptimer_period(priv->pin, period); | ||
89 | |||
90 | return 0; | ||
91 | } | ||
92 | |||
93 | static int bfin_pwm_enable(struct pwm_chip *chip, struct pwm_device *pwm) | ||
94 | { | ||
95 | struct bfin_pwm *priv = pwm_get_chip_data(pwm); | ||
96 | |||
97 | enable_gptimer(priv->pin); | ||
98 | |||
99 | return 0; | ||
100 | } | ||
101 | |||
102 | static void bfin_pwm_disable(struct pwm_chip *chip, struct pwm_device *pwm) | ||
103 | { | ||
104 | struct bfin_pwm *priv = pwm_get_chip_data(pwm); | ||
105 | |||
106 | disable_gptimer(priv->pin); | ||
107 | } | ||
108 | |||
109 | static struct pwm_ops bfin_pwm_ops = { | ||
110 | .request = bfin_pwm_request, | ||
111 | .free = bfin_pwm_free, | ||
112 | .config = bfin_pwm_config, | ||
113 | .enable = bfin_pwm_enable, | ||
114 | .disable = bfin_pwm_disable, | ||
115 | .owner = THIS_MODULE, | ||
116 | }; | ||
117 | |||
118 | static int bfin_pwm_probe(struct platform_device *pdev) | ||
119 | { | ||
120 | struct bfin_pwm_chip *pwm; | ||
121 | int ret; | ||
122 | |||
123 | pwm = devm_kzalloc(&pdev->dev, sizeof(*pwm), GFP_KERNEL); | ||
124 | if (!pwm) { | ||
125 | dev_err(&pdev->dev, "failed to allocate memory\n"); | ||
126 | return -ENOMEM; | ||
127 | } | ||
128 | |||
129 | platform_set_drvdata(pdev, pwm); | ||
130 | |||
131 | pwm->chip.dev = &pdev->dev; | ||
132 | pwm->chip.ops = &bfin_pwm_ops; | ||
133 | pwm->chip.base = -1; | ||
134 | pwm->chip.npwm = 12; | ||
135 | |||
136 | ret = pwmchip_add(&pwm->chip); | ||
137 | if (ret < 0) { | ||
138 | dev_err(&pdev->dev, "pwmchip_add() failed: %d\n", ret); | ||
139 | return ret; | ||
140 | } | ||
141 | |||
142 | return 0; | ||
143 | } | ||
144 | |||
145 | static int __devexit bfin_pwm_remove(struct platform_device *pdev) | ||
146 | { | ||
147 | struct bfin_pwm_chip *pwm = platform_get_drvdata(pdev); | ||
148 | |||
149 | return pwmchip_remove(&pwm->chip); | ||
150 | } | ||
151 | |||
152 | static struct platform_driver bfin_pwm_driver = { | ||
153 | .driver = { | ||
154 | .name = "bfin-pwm", | ||
155 | }, | ||
156 | .probe = bfin_pwm_probe, | ||
157 | .remove = __devexit_p(bfin_pwm_remove), | ||
158 | }; | ||
159 | |||
160 | module_platform_driver(bfin_pwm_driver); | ||
161 | |||
162 | MODULE_LICENSE("GPL"); | ||