fdt_i2c.c revision 1.2.2.2 1 1.2.2.2 skrll /* $NetBSD: fdt_i2c.c,v 1.2.2.2 2015/12/27 12:09:49 skrll Exp $ */
2 1.2.2.2 skrll
3 1.2.2.2 skrll /*-
4 1.2.2.2 skrll * Copyright (c) 2015 Jared D. McNeill <jmcneill (at) invisible.ca>
5 1.2.2.2 skrll * All rights reserved.
6 1.2.2.2 skrll *
7 1.2.2.2 skrll * Redistribution and use in source and binary forms, with or without
8 1.2.2.2 skrll * modification, are permitted provided that the following conditions
9 1.2.2.2 skrll * are met:
10 1.2.2.2 skrll * 1. Redistributions of source code must retain the above copyright
11 1.2.2.2 skrll * notice, this list of conditions and the following disclaimer.
12 1.2.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright
13 1.2.2.2 skrll * notice, this list of conditions and the following disclaimer in the
14 1.2.2.2 skrll * documentation and/or other materials provided with the distribution.
15 1.2.2.2 skrll *
16 1.2.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.2.2.2 skrll * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.2.2.2 skrll * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.2.2.2 skrll * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.2.2.2 skrll * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
21 1.2.2.2 skrll * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22 1.2.2.2 skrll * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
23 1.2.2.2 skrll * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
24 1.2.2.2 skrll * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25 1.2.2.2 skrll * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26 1.2.2.2 skrll * SUCH DAMAGE.
27 1.2.2.2 skrll */
28 1.2.2.2 skrll
29 1.2.2.2 skrll #include <sys/cdefs.h>
30 1.2.2.2 skrll __KERNEL_RCSID(0, "$NetBSD: fdt_i2c.c,v 1.2.2.2 2015/12/27 12:09:49 skrll Exp $");
31 1.2.2.2 skrll
32 1.2.2.2 skrll #include <sys/param.h>
33 1.2.2.2 skrll #include <sys/bus.h>
34 1.2.2.2 skrll #include <sys/kmem.h>
35 1.2.2.2 skrll
36 1.2.2.2 skrll #include <libfdt.h>
37 1.2.2.2 skrll #include <dev/fdt/fdtvar.h>
38 1.2.2.2 skrll
39 1.2.2.2 skrll struct fdtbus_i2c_controller {
40 1.2.2.2 skrll device_t i2c_dev;
41 1.2.2.2 skrll int i2c_phandle;
42 1.2.2.2 skrll const struct fdtbus_i2c_controller_func *i2c_funcs;
43 1.2.2.2 skrll
44 1.2.2.2 skrll struct fdtbus_i2c_controller *i2c_next;
45 1.2.2.2 skrll };
46 1.2.2.2 skrll
47 1.2.2.2 skrll static struct fdtbus_i2c_controller *fdtbus_i2c = NULL;
48 1.2.2.2 skrll
49 1.2.2.2 skrll int
50 1.2.2.2 skrll fdtbus_register_i2c_controller(device_t dev, int phandle,
51 1.2.2.2 skrll const struct fdtbus_i2c_controller_func *funcs)
52 1.2.2.2 skrll {
53 1.2.2.2 skrll struct fdtbus_i2c_controller *i2c;
54 1.2.2.2 skrll
55 1.2.2.2 skrll i2c = kmem_alloc(sizeof(*i2c), KM_SLEEP);
56 1.2.2.2 skrll i2c->i2c_dev = dev;
57 1.2.2.2 skrll i2c->i2c_phandle = phandle;
58 1.2.2.2 skrll i2c->i2c_funcs = funcs;
59 1.2.2.2 skrll
60 1.2.2.2 skrll i2c->i2c_next = fdtbus_i2c;
61 1.2.2.2 skrll fdtbus_i2c = i2c;
62 1.2.2.2 skrll
63 1.2.2.2 skrll return 0;
64 1.2.2.2 skrll }
65 1.2.2.2 skrll
66 1.2.2.2 skrll static struct fdtbus_i2c_controller *
67 1.2.2.2 skrll fdtbus_get_i2c_controller(int phandle)
68 1.2.2.2 skrll {
69 1.2.2.2 skrll struct fdtbus_i2c_controller *i2c;
70 1.2.2.2 skrll
71 1.2.2.2 skrll for (i2c = fdtbus_i2c; i2c; i2c = i2c->i2c_next) {
72 1.2.2.2 skrll if (i2c->i2c_phandle == phandle) {
73 1.2.2.2 skrll return i2c;
74 1.2.2.2 skrll }
75 1.2.2.2 skrll }
76 1.2.2.2 skrll
77 1.2.2.2 skrll return NULL;
78 1.2.2.2 skrll }
79 1.2.2.2 skrll
80 1.2.2.2 skrll i2c_tag_t
81 1.2.2.2 skrll fdtbus_get_i2c_tag(int phandle)
82 1.2.2.2 skrll {
83 1.2.2.2 skrll struct fdtbus_i2c_controller *i2c;
84 1.2.2.2 skrll
85 1.2.2.2 skrll i2c = fdtbus_get_i2c_controller(phandle);
86 1.2.2.2 skrll if (i2c == NULL)
87 1.2.2.2 skrll return NULL;
88 1.2.2.2 skrll
89 1.2.2.2 skrll return i2c->i2c_funcs->get_tag(i2c->i2c_dev);
90 1.2.2.2 skrll }
91