pwm_fan.c revision 1.2 1 1.2 thorpej /* $NetBSD: pwm_fan.c,v 1.2 2021/01/27 03:10:21 thorpej Exp $ */
2 1.1 jmcneill
3 1.1 jmcneill /*-
4 1.1 jmcneill * Copyright (c) 2018 Jared McNeill <jmcneill (at) invisible.ca>
5 1.1 jmcneill * All rights reserved.
6 1.1 jmcneill *
7 1.1 jmcneill * Redistribution and use in source and binary forms, with or without
8 1.1 jmcneill * modification, are permitted provided that the following conditions
9 1.1 jmcneill * are met:
10 1.1 jmcneill * 1. Redistributions of source code must retain the above copyright
11 1.1 jmcneill * notice, this list of conditions and the following disclaimer.
12 1.1 jmcneill * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 jmcneill * notice, this list of conditions and the following disclaimer in the
14 1.1 jmcneill * documentation and/or other materials provided with the distribution.
15 1.1 jmcneill *
16 1.1 jmcneill * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 jmcneill * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 jmcneill * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 jmcneill * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 jmcneill * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1 jmcneill * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1 jmcneill * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1 jmcneill * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1 jmcneill * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1 jmcneill * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1 jmcneill * SUCH DAMAGE.
27 1.1 jmcneill */
28 1.1 jmcneill
29 1.1 jmcneill #include <sys/cdefs.h>
30 1.2 thorpej __KERNEL_RCSID(0, "$NetBSD: pwm_fan.c,v 1.2 2021/01/27 03:10:21 thorpej Exp $");
31 1.1 jmcneill
32 1.1 jmcneill #include <sys/param.h>
33 1.1 jmcneill #include <sys/bus.h>
34 1.1 jmcneill #include <sys/device.h>
35 1.1 jmcneill #include <sys/systm.h>
36 1.1 jmcneill #include <sys/sysctl.h>
37 1.1 jmcneill #include <sys/kmem.h>
38 1.1 jmcneill #include <sys/gpio.h>
39 1.1 jmcneill
40 1.1 jmcneill #include <dev/pwm/pwmvar.h>
41 1.1 jmcneill
42 1.1 jmcneill #include <dev/fdt/fdtvar.h>
43 1.1 jmcneill
44 1.1 jmcneill struct pwm_fan_softc {
45 1.1 jmcneill device_t sc_dev;
46 1.1 jmcneill pwm_tag_t sc_pwm;
47 1.1 jmcneill struct fdtbus_gpio_pin *sc_pin;
48 1.1 jmcneill
49 1.1 jmcneill u_int *sc_levels;
50 1.1 jmcneill u_int sc_nlevels;
51 1.1 jmcneill };
52 1.1 jmcneill
53 1.1 jmcneill static int pwm_fan_match(device_t, cfdata_t, void *);
54 1.1 jmcneill static void pwm_fan_attach(device_t, device_t, void *);
55 1.1 jmcneill
56 1.1 jmcneill static void pwm_fan_set(struct pwm_fan_softc *, u_int);
57 1.1 jmcneill
58 1.2 thorpej static const struct device_compatible_entry compat_data[] = {
59 1.2 thorpej { .compat = "pwm-fan" },
60 1.2 thorpej DEVICE_COMPAT_EOL
61 1.1 jmcneill };
62 1.1 jmcneill
63 1.1 jmcneill CFATTACH_DECL_NEW(pwmfan, sizeof(struct pwm_fan_softc),
64 1.1 jmcneill pwm_fan_match, pwm_fan_attach, NULL, NULL);
65 1.1 jmcneill
66 1.1 jmcneill static int
67 1.1 jmcneill pwm_fan_match(device_t parent, cfdata_t cf, void *aux)
68 1.1 jmcneill {
69 1.1 jmcneill struct fdt_attach_args * const faa = aux;
70 1.1 jmcneill
71 1.2 thorpej return of_compatible_match(faa->faa_phandle, compat_data);
72 1.1 jmcneill }
73 1.1 jmcneill
74 1.1 jmcneill static void
75 1.1 jmcneill pwm_fan_attach(device_t parent, device_t self, void *aux)
76 1.1 jmcneill {
77 1.1 jmcneill struct pwm_fan_softc * const sc = device_private(self);
78 1.1 jmcneill struct fdt_attach_args * const faa = aux;
79 1.1 jmcneill const int phandle = faa->faa_phandle;
80 1.1 jmcneill const u_int *levels;
81 1.1 jmcneill u_int n;
82 1.1 jmcneill int len;
83 1.1 jmcneill
84 1.1 jmcneill sc->sc_dev = self;
85 1.1 jmcneill sc->sc_pwm = fdtbus_pwm_acquire(phandle, "pwms");
86 1.1 jmcneill if (sc->sc_pwm == NULL) {
87 1.1 jmcneill aprint_error(": couldn't acquire pwm\n");
88 1.1 jmcneill return;
89 1.1 jmcneill }
90 1.1 jmcneill
91 1.1 jmcneill levels = fdtbus_get_prop(phandle, "cooling-levels", &len);
92 1.1 jmcneill if (len < 4) {
93 1.1 jmcneill aprint_error(": couldn't get 'cooling-levels' property\n");
94 1.1 jmcneill return;
95 1.1 jmcneill }
96 1.1 jmcneill sc->sc_levels = kmem_alloc(len, KM_SLEEP);
97 1.1 jmcneill sc->sc_nlevels = len / 4;
98 1.1 jmcneill for (n = 0; n < sc->sc_nlevels; n++)
99 1.1 jmcneill sc->sc_levels[n] = be32toh(levels[n]);
100 1.1 jmcneill
101 1.1 jmcneill aprint_naive("\n");
102 1.1 jmcneill aprint_normal(": PWM Fan");
103 1.1 jmcneill aprint_normal(" (levels");
104 1.1 jmcneill for (n = 0; n < sc->sc_nlevels; n++) {
105 1.1 jmcneill aprint_normal(" %u%%", (sc->sc_levels[n] * 100) / 255);
106 1.1 jmcneill }
107 1.1 jmcneill aprint_normal(")\n");
108 1.1 jmcneill
109 1.1 jmcneill /* Select the highest cooling level */
110 1.1 jmcneill pwm_fan_set(sc, 255);
111 1.1 jmcneill }
112 1.1 jmcneill
113 1.1 jmcneill static void
114 1.1 jmcneill pwm_fan_set(struct pwm_fan_softc *sc, u_int level)
115 1.1 jmcneill {
116 1.1 jmcneill struct pwm_config conf;
117 1.1 jmcneill
118 1.1 jmcneill if (level > 255)
119 1.1 jmcneill level = 255;
120 1.1 jmcneill
121 1.1 jmcneill aprint_debug_dev(sc->sc_dev, "set duty cycle to %u%%\n", (level * 100) / 255);
122 1.1 jmcneill
123 1.1 jmcneill pwm_disable(sc->sc_pwm);
124 1.1 jmcneill pwm_get_config(sc->sc_pwm, &conf);
125 1.1 jmcneill conf.duty_cycle = (conf.period * level) / 255;
126 1.1 jmcneill pwm_set_config(sc->sc_pwm, &conf);
127 1.1 jmcneill pwm_enable(sc->sc_pwm);
128 1.1 jmcneill }
129