fdt_mmc_pwrseq.c revision 1.1.2.2 1 1.1.2.2 jdolecek /* $NetBSD: fdt_mmc_pwrseq.c,v 1.1.2.2 2017/12/03 11:37:01 jdolecek Exp $ */
2 1.1.2.2 jdolecek
3 1.1.2.2 jdolecek /*-
4 1.1.2.2 jdolecek * Copyright (c) 2017 Jared McNeill <jmcneill (at) invisible.ca>
5 1.1.2.2 jdolecek * All rights reserved.
6 1.1.2.2 jdolecek *
7 1.1.2.2 jdolecek * Redistribution and use in source and binary forms, with or without
8 1.1.2.2 jdolecek * modification, are permitted provided that the following conditions
9 1.1.2.2 jdolecek * are met:
10 1.1.2.2 jdolecek * 1. Redistributions of source code must retain the above copyright
11 1.1.2.2 jdolecek * notice, this list of conditions and the following disclaimer.
12 1.1.2.2 jdolecek * 2. Redistributions in binary form must reproduce the above copyright
13 1.1.2.2 jdolecek * notice, this list of conditions and the following disclaimer in the
14 1.1.2.2 jdolecek * documentation and/or other materials provided with the distribution.
15 1.1.2.2 jdolecek *
16 1.1.2.2 jdolecek * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1.2.2 jdolecek * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1.2.2 jdolecek * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1.2.2 jdolecek * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1.2.2 jdolecek * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.1.2.2 jdolecek * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.1.2.2 jdolecek * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.1.2.2 jdolecek * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.1.2.2 jdolecek * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.1.2.2 jdolecek * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.1.2.2 jdolecek * SUCH DAMAGE.
27 1.1.2.2 jdolecek */
28 1.1.2.2 jdolecek
29 1.1.2.2 jdolecek #include <sys/cdefs.h>
30 1.1.2.2 jdolecek __KERNEL_RCSID(0, "$NetBSD: fdt_mmc_pwrseq.c,v 1.1.2.2 2017/12/03 11:37:01 jdolecek Exp $");
31 1.1.2.2 jdolecek
32 1.1.2.2 jdolecek #include <sys/param.h>
33 1.1.2.2 jdolecek #include <sys/bus.h>
34 1.1.2.2 jdolecek #include <sys/kmem.h>
35 1.1.2.2 jdolecek
36 1.1.2.2 jdolecek #include <libfdt.h>
37 1.1.2.2 jdolecek #include <dev/fdt/fdtvar.h>
38 1.1.2.2 jdolecek
39 1.1.2.2 jdolecek struct fdtbus_mmc_pwrseq {
40 1.1.2.2 jdolecek device_t mps_dev;
41 1.1.2.2 jdolecek int mps_phandle;
42 1.1.2.2 jdolecek const struct fdtbus_mmc_pwrseq_func *mps_funcs;
43 1.1.2.2 jdolecek
44 1.1.2.2 jdolecek struct fdtbus_mmc_pwrseq *mps_next;
45 1.1.2.2 jdolecek };
46 1.1.2.2 jdolecek
47 1.1.2.2 jdolecek static struct fdtbus_mmc_pwrseq *fdtbus_mps = NULL;
48 1.1.2.2 jdolecek
49 1.1.2.2 jdolecek int
50 1.1.2.2 jdolecek fdtbus_register_mmc_pwrseq(device_t dev, int phandle,
51 1.1.2.2 jdolecek const struct fdtbus_mmc_pwrseq_func *funcs)
52 1.1.2.2 jdolecek {
53 1.1.2.2 jdolecek struct fdtbus_mmc_pwrseq *mps;
54 1.1.2.2 jdolecek
55 1.1.2.2 jdolecek mps = kmem_alloc(sizeof(*mps), KM_SLEEP);
56 1.1.2.2 jdolecek mps->mps_dev = dev;
57 1.1.2.2 jdolecek mps->mps_phandle = phandle;
58 1.1.2.2 jdolecek mps->mps_funcs = funcs;
59 1.1.2.2 jdolecek
60 1.1.2.2 jdolecek mps->mps_next = fdtbus_mps;
61 1.1.2.2 jdolecek fdtbus_mps = mps;
62 1.1.2.2 jdolecek
63 1.1.2.2 jdolecek return 0;
64 1.1.2.2 jdolecek }
65 1.1.2.2 jdolecek
66 1.1.2.2 jdolecek static struct fdtbus_mmc_pwrseq *
67 1.1.2.2 jdolecek fdtbus_get_mmc_pwrseq(int phandle)
68 1.1.2.2 jdolecek {
69 1.1.2.2 jdolecek struct fdtbus_mmc_pwrseq *mps;
70 1.1.2.2 jdolecek
71 1.1.2.2 jdolecek for (mps = fdtbus_mps; mps; mps = mps->mps_next) {
72 1.1.2.2 jdolecek if (mps->mps_phandle == phandle) {
73 1.1.2.2 jdolecek return mps;
74 1.1.2.2 jdolecek }
75 1.1.2.2 jdolecek }
76 1.1.2.2 jdolecek
77 1.1.2.2 jdolecek return NULL;
78 1.1.2.2 jdolecek }
79 1.1.2.2 jdolecek
80 1.1.2.2 jdolecek struct fdtbus_mmc_pwrseq *
81 1.1.2.2 jdolecek fdtbus_mmc_pwrseq_get(int phandle)
82 1.1.2.2 jdolecek {
83 1.1.2.2 jdolecek const u_int *p;
84 1.1.2.2 jdolecek int mps_phandle;
85 1.1.2.2 jdolecek
86 1.1.2.2 jdolecek p = fdtbus_get_prop(phandle, "mmc-pwrseq", NULL);
87 1.1.2.2 jdolecek if (p == NULL)
88 1.1.2.2 jdolecek return NULL;
89 1.1.2.2 jdolecek
90 1.1.2.2 jdolecek mps_phandle = fdtbus_get_phandle_from_native(be32toh(p[0]));
91 1.1.2.2 jdolecek return fdtbus_get_mmc_pwrseq(mps_phandle);
92 1.1.2.2 jdolecek }
93 1.1.2.2 jdolecek
94 1.1.2.2 jdolecek void
95 1.1.2.2 jdolecek fdtbus_mmc_pwrseq_pre_power_on(struct fdtbus_mmc_pwrseq *mps)
96 1.1.2.2 jdolecek {
97 1.1.2.2 jdolecek if (mps->mps_funcs->pre_power_on)
98 1.1.2.2 jdolecek mps->mps_funcs->pre_power_on(mps->mps_dev);
99 1.1.2.2 jdolecek }
100 1.1.2.2 jdolecek
101 1.1.2.2 jdolecek void
102 1.1.2.2 jdolecek fdtbus_mmc_pwrseq_post_power_on(struct fdtbus_mmc_pwrseq *mps)
103 1.1.2.2 jdolecek {
104 1.1.2.2 jdolecek if (mps->mps_funcs->post_power_on)
105 1.1.2.2 jdolecek mps->mps_funcs->post_power_on(mps->mps_dev);
106 1.1.2.2 jdolecek }
107 1.1.2.2 jdolecek
108 1.1.2.2 jdolecek void
109 1.1.2.2 jdolecek fdtbus_mmc_pwrseq_power_off(struct fdtbus_mmc_pwrseq *mps)
110 1.1.2.2 jdolecek {
111 1.1.2.2 jdolecek if (mps->mps_funcs->power_off)
112 1.1.2.2 jdolecek mps->mps_funcs->power_off(mps->mps_dev);
113 1.1.2.2 jdolecek }
114 1.1.2.2 jdolecek
115 1.1.2.2 jdolecek void
116 1.1.2.2 jdolecek fdtbus_mmc_pwrseq_reset(struct fdtbus_mmc_pwrseq *mps)
117 1.1.2.2 jdolecek {
118 1.1.2.2 jdolecek if (mps->mps_funcs->reset)
119 1.1.2.2 jdolecek mps->mps_funcs->reset(mps->mps_dev);
120 1.1.2.2 jdolecek }
121