]>
Commit | Line | Data |
---|---|---|
7429b962 SG |
1 | /* |
2 | * Copyright 2016 Google Inc. | |
3 | * | |
4 | * SPDX-License-Identifier: GPL-2.0+ | |
5 | */ | |
6 | ||
7 | #include <common.h> | |
8 | #include <dm.h> | |
9 | #include <pwm.h> | |
10 | #include <asm/io.h> | |
11 | #include <asm/arch/clock.h> | |
12 | #include <asm/arch/pwm.h> | |
13 | ||
14 | DECLARE_GLOBAL_DATA_PTR; | |
15 | ||
16 | struct tegra_pwm_priv { | |
17 | struct pwm_ctlr *regs; | |
18 | }; | |
19 | ||
20 | static int tegra_pwm_set_config(struct udevice *dev, uint channel, | |
21 | uint period_ns, uint duty_ns) | |
22 | { | |
23 | struct tegra_pwm_priv *priv = dev_get_priv(dev); | |
24 | struct pwm_ctlr *regs = priv->regs; | |
25 | uint pulse_width; | |
26 | u32 reg; | |
27 | ||
28 | if (channel >= 4) | |
29 | return -EINVAL; | |
30 | debug("%s: Configure '%s' channel %u\n", __func__, dev->name, channel); | |
31 | /* We ignore the period here and just use 32KHz */ | |
32 | clock_start_periph_pll(PERIPH_ID_PWM, CLOCK_ID_SFROM32KHZ, 32768); | |
33 | ||
34 | pulse_width = duty_ns * 255 / period_ns; | |
35 | ||
36 | reg = pulse_width << PWM_WIDTH_SHIFT; | |
37 | reg |= 1 << PWM_DIVIDER_SHIFT; | |
38 | writel(reg, ®s[channel].control); | |
39 | debug("%s: pulse_width=%u\n", __func__, pulse_width); | |
40 | ||
41 | return 0; | |
42 | } | |
43 | ||
44 | static int tegra_pwm_set_enable(struct udevice *dev, uint channel, bool enable) | |
45 | { | |
46 | struct tegra_pwm_priv *priv = dev_get_priv(dev); | |
47 | struct pwm_ctlr *regs = priv->regs; | |
48 | ||
49 | if (channel >= 4) | |
50 | return -EINVAL; | |
51 | debug("%s: Enable '%s' channel %u\n", __func__, dev->name, channel); | |
52 | clrsetbits_le32(®s[channel].control, PWM_ENABLE_MASK, | |
53 | enable ? PWM_ENABLE_MASK : 0); | |
54 | ||
55 | return 0; | |
56 | } | |
57 | ||
58 | static int tegra_pwm_ofdata_to_platdata(struct udevice *dev) | |
59 | { | |
60 | struct tegra_pwm_priv *priv = dev_get_priv(dev); | |
61 | ||
4b0f21cf | 62 | priv->regs = (struct pwm_ctlr *)dev_read_addr(dev); |
7429b962 SG |
63 | |
64 | return 0; | |
65 | } | |
66 | ||
67 | static const struct pwm_ops tegra_pwm_ops = { | |
68 | .set_config = tegra_pwm_set_config, | |
69 | .set_enable = tegra_pwm_set_enable, | |
70 | }; | |
71 | ||
72 | static const struct udevice_id tegra_pwm_ids[] = { | |
73 | { .compatible = "nvidia,tegra124-pwm" }, | |
74 | { .compatible = "nvidia,tegra20-pwm" }, | |
75 | { } | |
76 | }; | |
77 | ||
78 | U_BOOT_DRIVER(tegra_pwm) = { | |
79 | .name = "tegra_pwm", | |
80 | .id = UCLASS_PWM, | |
81 | .of_match = tegra_pwm_ids, | |
82 | .ops = &tegra_pwm_ops, | |
83 | .ofdata_to_platdata = tegra_pwm_ofdata_to_platdata, | |
84 | .priv_auto_alloc_size = sizeof(struct tegra_pwm_priv), | |
85 | }; |