gpio.c revision 1.8 1 1.8 mbalmer /* $NetBSD: gpio.c,v 1.8 2013/10/26 09:18:00 mbalmer Exp $ */
2 1.2 mbalmer
3 1.1 mbalmer /*
4 1.1 mbalmer * Copyright (c) 2011 Marc Balmer <marc (at) msys.ch>
5 1.1 mbalmer * All rights reserved.
6 1.1 mbalmer *
7 1.1 mbalmer * Redistribution and use in source and binary forms, with or without
8 1.1 mbalmer * modification, are permitted provided that the following conditions
9 1.1 mbalmer * are met:
10 1.1 mbalmer * 1. Redistributions of source code must retain the above copyright
11 1.1 mbalmer * notice, this list of conditions and the following disclaimer.
12 1.1 mbalmer * 2. Redistributions in binary form must reproduce the above copyright
13 1.1 mbalmer * notice, this list of conditions and the following disclaimer in the
14 1.1 mbalmer * documentation and/or other materials provided with the distribution.
15 1.1 mbalmer *
16 1.1 mbalmer * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
17 1.1 mbalmer * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
18 1.1 mbalmer * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
19 1.1 mbalmer * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
20 1.1 mbalmer * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
21 1.1 mbalmer * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
22 1.1 mbalmer * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
23 1.1 mbalmer * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24 1.1 mbalmer * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
25 1.1 mbalmer * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26 1.1 mbalmer */
27 1.1 mbalmer
28 1.1 mbalmer /* GPIO interface for Lua */
29 1.1 mbalmer
30 1.1 mbalmer #include <errno.h>
31 1.1 mbalmer #include <fcntl.h>
32 1.1 mbalmer #include <stdarg.h>
33 1.1 mbalmer #include <stdio.h>
34 1.1 mbalmer #include <string.h>
35 1.1 mbalmer #include <ctype.h>
36 1.1 mbalmer #include <stdlib.h>
37 1.1 mbalmer #include <unistd.h>
38 1.1 mbalmer
39 1.1 mbalmer #include <lua.h>
40 1.1 mbalmer #include <lauxlib.h>
41 1.1 mbalmer #include <lualib.h>
42 1.1 mbalmer
43 1.1 mbalmer #include <sys/gpio.h>
44 1.1 mbalmer #include <sys/ioctl.h>
45 1.1 mbalmer
46 1.1 mbalmer #define GPIO_METATABLE "GPIO object methods"
47 1.1 mbalmer
48 1.7 joerg static __printflike(2, 3) void
49 1.1 mbalmer gpio_error(lua_State *L, const char *fmt, ...)
50 1.1 mbalmer {
51 1.1 mbalmer va_list ap;
52 1.1 mbalmer int len;
53 1.1 mbalmer char *msg;
54 1.1 mbalmer
55 1.1 mbalmer va_start(ap, fmt);
56 1.1 mbalmer len = vasprintf(&msg, fmt, ap);
57 1.1 mbalmer va_end(ap);
58 1.1 mbalmer
59 1.1 mbalmer if (len != -1) {
60 1.1 mbalmer lua_pushstring(L, msg);
61 1.1 mbalmer free(msg);
62 1.1 mbalmer } else
63 1.1 mbalmer lua_pushstring(L, "vasprintf failed");
64 1.1 mbalmer lua_error(L);
65 1.1 mbalmer }
66 1.1 mbalmer
67 1.1 mbalmer static int
68 1.1 mbalmer gpio_open(lua_State *L)
69 1.1 mbalmer {
70 1.1 mbalmer int *fd;
71 1.1 mbalmer
72 1.1 mbalmer fd = lua_newuserdata(L, sizeof(int));
73 1.1 mbalmer *fd = open(luaL_checkstring(L, -2), O_RDWR);
74 1.1 mbalmer if (*fd == -1) {
75 1.1 mbalmer gpio_error(L, "%s", strerror(errno));
76 1.1 mbalmer /* NOTREACHED */
77 1.1 mbalmer return 0;
78 1.1 mbalmer }
79 1.1 mbalmer luaL_getmetatable(L, GPIO_METATABLE);
80 1.1 mbalmer lua_setmetatable(L, -2);
81 1.1 mbalmer return 1;
82 1.1 mbalmer }
83 1.1 mbalmer
84 1.1 mbalmer static int
85 1.1 mbalmer gpio_close(lua_State *L)
86 1.1 mbalmer {
87 1.1 mbalmer int *fd;
88 1.1 mbalmer
89 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
90 1.1 mbalmer if (*fd != -1) {
91 1.1 mbalmer close(*fd);
92 1.1 mbalmer *fd = -1;
93 1.1 mbalmer }
94 1.1 mbalmer return 0;
95 1.1 mbalmer }
96 1.1 mbalmer
97 1.1 mbalmer static int
98 1.1 mbalmer gpio_info(lua_State *L)
99 1.1 mbalmer {
100 1.1 mbalmer struct gpio_info info;
101 1.1 mbalmer int *fd;
102 1.1 mbalmer
103 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
104 1.1 mbalmer if (ioctl(*fd, GPIOINFO, &info) == -1)
105 1.1 mbalmer gpio_error(L, "GPIOINFO");
106 1.1 mbalmer lua_pushinteger(L, info.gpio_npins);
107 1.1 mbalmer return 1;
108 1.1 mbalmer }
109 1.1 mbalmer
110 1.1 mbalmer static void
111 1.1 mbalmer gpio_get_pin(lua_State *L, int n, struct gpio_req *req)
112 1.1 mbalmer {
113 1.1 mbalmer switch (lua_type(L, n)) {
114 1.1 mbalmer case LUA_TNUMBER:
115 1.4 mbalmer req->gp_pin = (int)lua_tointeger(L, n); /* not 1 based! */
116 1.1 mbalmer break;
117 1.1 mbalmer case LUA_TSTRING:
118 1.1 mbalmer strlcpy(req->gp_name, lua_tostring(L, n), sizeof(req->gp_name));
119 1.1 mbalmer break;
120 1.1 mbalmer default:
121 1.1 mbalmer luaL_argerror(L, n, "expected string or integer");
122 1.1 mbalmer /* NOTREACHED */
123 1.1 mbalmer }
124 1.1 mbalmer }
125 1.1 mbalmer
126 1.1 mbalmer static int
127 1.1 mbalmer gpio_set(lua_State *L)
128 1.1 mbalmer {
129 1.1 mbalmer struct gpio_set set;
130 1.1 mbalmer int *fd;
131 1.1 mbalmer
132 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
133 1.1 mbalmer memset(&set, 0, sizeof(set));
134 1.3 christos gpio_get_pin(L, 2, (void *)&set);
135 1.3 christos set.gp_flags = (int)luaL_checkinteger(L, 3);
136 1.1 mbalmer if (ioctl(*fd, GPIOSET, &set) == -1)
137 1.1 mbalmer gpio_error(L, "GPIOSET");
138 1.1 mbalmer return 0;
139 1.1 mbalmer }
140 1.1 mbalmer
141 1.1 mbalmer static int
142 1.1 mbalmer gpio_unset(lua_State *L)
143 1.1 mbalmer {
144 1.1 mbalmer struct gpio_set set;
145 1.1 mbalmer int *fd;
146 1.1 mbalmer
147 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
148 1.1 mbalmer memset(&set, 0, sizeof(set));
149 1.3 christos gpio_get_pin(L, 2, (void *)&set);
150 1.1 mbalmer if (ioctl(*fd, GPIOUNSET, &set) == -1)
151 1.1 mbalmer gpio_error(L, "GPIOUNSET");
152 1.1 mbalmer return 0;
153 1.1 mbalmer }
154 1.1 mbalmer
155 1.1 mbalmer static int
156 1.1 mbalmer gpio_read(lua_State *L)
157 1.1 mbalmer {
158 1.1 mbalmer struct gpio_req req;
159 1.1 mbalmer int *fd;
160 1.1 mbalmer
161 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
162 1.1 mbalmer memset(&req, 0, sizeof(req));
163 1.1 mbalmer gpio_get_pin(L, 2, &req);
164 1.1 mbalmer if (ioctl(*fd, GPIOREAD, &req) == -1)
165 1.1 mbalmer gpio_error(L, "GPIOREAD");
166 1.1 mbalmer lua_pushinteger(L, req.gp_value);
167 1.1 mbalmer return 1;
168 1.1 mbalmer }
169 1.1 mbalmer
170 1.1 mbalmer
171 1.1 mbalmer static int
172 1.1 mbalmer gpio_write(lua_State *L)
173 1.1 mbalmer {
174 1.1 mbalmer struct gpio_req req;
175 1.1 mbalmer int *fd, val;
176 1.1 mbalmer
177 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
178 1.3 christos val = (int)luaL_checkinteger(L, 3);
179 1.1 mbalmer if (val != GPIO_PIN_HIGH && val != GPIO_PIN_LOW)
180 1.1 mbalmer gpio_error(L, "%d: invalid value", val);
181 1.1 mbalmer memset(&req, 0, sizeof(req));
182 1.1 mbalmer gpio_get_pin(L, 2, &req);
183 1.1 mbalmer req.gp_value = val;
184 1.1 mbalmer if (ioctl(*fd, GPIOWRITE, &req) == -1)
185 1.1 mbalmer gpio_error(L, "GPIOWRITE");
186 1.1 mbalmer lua_pushinteger(L, req.gp_value);
187 1.1 mbalmer return 1;
188 1.1 mbalmer }
189 1.1 mbalmer
190 1.1 mbalmer static int
191 1.1 mbalmer gpio_toggle(lua_State *L)
192 1.1 mbalmer {
193 1.1 mbalmer struct gpio_req req;
194 1.3 christos int *fd;
195 1.1 mbalmer
196 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
197 1.1 mbalmer memset(&req, 0, sizeof(req));
198 1.1 mbalmer gpio_get_pin(L, 2, &req);
199 1.1 mbalmer if (ioctl(*fd, GPIOTOGGLE, &req) == -1)
200 1.1 mbalmer gpio_error(L, "GPIOTOGGLE");
201 1.1 mbalmer lua_pushinteger(L, req.gp_value);
202 1.1 mbalmer return 1;
203 1.1 mbalmer }
204 1.1 mbalmer
205 1.1 mbalmer static int
206 1.1 mbalmer gpio_attach(lua_State *L)
207 1.1 mbalmer {
208 1.1 mbalmer struct gpio_attach attach;
209 1.1 mbalmer int *fd;
210 1.1 mbalmer
211 1.1 mbalmer fd = luaL_checkudata(L, 1, GPIO_METATABLE);
212 1.1 mbalmer memset(&attach, 0, sizeof(attach));
213 1.1 mbalmer strlcpy(attach.ga_dvname, luaL_checkstring(L, 2),
214 1.1 mbalmer sizeof(attach.ga_dvname));
215 1.3 christos attach.ga_offset = (int)luaL_checkinteger(L, 3);
216 1.3 christos attach.ga_mask = (int)luaL_checkinteger(L, 4);
217 1.1 mbalmer if (lua_gettop(L) > 4)
218 1.3 christos attach.ga_flags = (int)luaL_checkinteger(L, 5);
219 1.1 mbalmer else
220 1.1 mbalmer attach.ga_flags = 0;
221 1.1 mbalmer
222 1.1 mbalmer if (ioctl(*fd, GPIOATTACH, &attach) == -1)
223 1.1 mbalmer gpio_error(L, "GPIOATTACH");
224 1.1 mbalmer return 0;
225 1.1 mbalmer }
226 1.1 mbalmer
227 1.1 mbalmer struct constant {
228 1.3 christos const char *name;
229 1.1 mbalmer int value;
230 1.1 mbalmer };
231 1.1 mbalmer
232 1.3 christos static const struct constant gpio_constant[] = {
233 1.1 mbalmer /* GPIO pin states */
234 1.1 mbalmer { "PIN_LOW", GPIO_PIN_LOW },
235 1.1 mbalmer { "PIN_HIGH", GPIO_PIN_HIGH },
236 1.1 mbalmer
237 1.1 mbalmer /* GPIO pin configuration flags */
238 1.1 mbalmer { "PIN_INPUT", GPIO_PIN_INPUT },
239 1.1 mbalmer { "PIN_OUTPUT", GPIO_PIN_OUTPUT },
240 1.1 mbalmer { "PIN_INOUT", GPIO_PIN_INOUT },
241 1.1 mbalmer { "PIN_OPENDRAIN", GPIO_PIN_OPENDRAIN },
242 1.1 mbalmer { "PIN_PUSHPULL", GPIO_PIN_PUSHPULL },
243 1.1 mbalmer { "PIN_TRISTATE", GPIO_PIN_TRISTATE },
244 1.1 mbalmer { "PIN_PULLUP", GPIO_PIN_PULLUP },
245 1.1 mbalmer { "PIN_PULLDOWN", GPIO_PIN_PULLDOWN },
246 1.1 mbalmer { "PIN_INVIN", GPIO_PIN_INVIN },
247 1.1 mbalmer { "PIN_INVOUT", GPIO_PIN_INVOUT },
248 1.1 mbalmer { "PIN_USER", GPIO_PIN_USER },
249 1.1 mbalmer { "PIN_PULSATE", GPIO_PIN_PULSATE },
250 1.1 mbalmer { "PIN_SET", GPIO_PIN_SET },
251 1.1 mbalmer { NULL, 0 }
252 1.1 mbalmer };
253 1.1 mbalmer
254 1.1 mbalmer static void
255 1.1 mbalmer gpio_set_info(lua_State *L)
256 1.1 mbalmer {
257 1.1 mbalmer lua_pushliteral(L, "_COPYRIGHT");
258 1.8 mbalmer lua_pushliteral(L, "Copyright (C) 2011, 2013 Marc Balmer "
259 1.8 mbalmer "<marc (at) msys.ch>");
260 1.1 mbalmer lua_settable(L, -3);
261 1.1 mbalmer lua_pushliteral(L, "_DESCRIPTION");
262 1.1 mbalmer lua_pushliteral(L, "GPIO interface for Lua");
263 1.1 mbalmer lua_settable(L, -3);
264 1.1 mbalmer lua_pushliteral(L, "_VERSION");
265 1.8 mbalmer lua_pushliteral(L, "gpio 1.0.2");
266 1.1 mbalmer lua_settable(L, -3);
267 1.1 mbalmer }
268 1.1 mbalmer
269 1.3 christos int luaopen_gpio(lua_State*);
270 1.3 christos
271 1.1 mbalmer int
272 1.1 mbalmer luaopen_gpio(lua_State* L)
273 1.1 mbalmer {
274 1.1 mbalmer static const struct luaL_Reg methods[] = {
275 1.1 mbalmer { "open", gpio_open },
276 1.1 mbalmer { NULL, NULL }
277 1.1 mbalmer };
278 1.1 mbalmer static const struct luaL_Reg gpio_methods[] = {
279 1.1 mbalmer { "info", gpio_info },
280 1.1 mbalmer { "close", gpio_close },
281 1.1 mbalmer { "set", gpio_set },
282 1.1 mbalmer { "unset", gpio_unset },
283 1.1 mbalmer { "read", gpio_read },
284 1.1 mbalmer { "write", gpio_write },
285 1.1 mbalmer { "toggle", gpio_toggle },
286 1.1 mbalmer { "attach", gpio_attach },
287 1.1 mbalmer { NULL, NULL }
288 1.1 mbalmer };
289 1.1 mbalmer int n;
290 1.1 mbalmer
291 1.1 mbalmer luaL_register(L, "gpio", methods);
292 1.8 mbalmer luaL_register(L, NULL, gpio_methods);
293 1.1 mbalmer gpio_set_info(L);
294 1.1 mbalmer
295 1.1 mbalmer /* The gpio metatable */
296 1.1 mbalmer if (luaL_newmetatable(L, GPIO_METATABLE)) {
297 1.1 mbalmer luaL_register(L, NULL, gpio_methods);
298 1.1 mbalmer
299 1.1 mbalmer lua_pushliteral(L, "__gc");
300 1.1 mbalmer lua_pushcfunction(L, gpio_close);
301 1.1 mbalmer lua_settable(L, -3);
302 1.1 mbalmer
303 1.1 mbalmer lua_pushliteral(L, "__index");
304 1.1 mbalmer lua_pushvalue(L, -2);
305 1.1 mbalmer lua_settable(L, -3);
306 1.1 mbalmer
307 1.1 mbalmer lua_pushliteral(L, "__metatable");
308 1.1 mbalmer lua_pushliteral(L, "must not access this metatable");
309 1.1 mbalmer lua_settable(L, -3);
310 1.1 mbalmer }
311 1.1 mbalmer lua_pop(L, 1);
312 1.1 mbalmer
313 1.1 mbalmer for (n = 0; gpio_constant[n].name != NULL; n++) {
314 1.1 mbalmer lua_pushinteger(L, gpio_constant[n].value);
315 1.1 mbalmer lua_setfield(L, -2, gpio_constant[n].name);
316 1.1 mbalmer };
317 1.1 mbalmer return 1;
318 1.1 mbalmer }
319