Annotation of freem/src/ssvn_zrpi.c, revision 1.3
1.1 snw 1: /*
1.3 ! snw 2: * $Id$
1.1 snw 3: * Support for Raspberry Pi single-board computers
4: *
5: *
1.2 snw 6: * Author: Serena Willis <snw@coherent-logic.com>
1.1 snw 7: * Copyright (C) 1998 MUG Deutschland
1.3 ! snw 8: * Copyright (C) 2020, 2025 Coherent Logic Development LLC
1.1 snw 9: *
10: *
11: * This file is part of FreeM.
12: *
13: * FreeM is free software: you can redistribute it and/or modify
14: * it under the terms of the GNU Affero General Public License as published by
15: * the Free Software Foundation, either version 3 of the License, or
16: * (at your option) any later version.
17: *
18: * FreeM is distributed in the hope that it will be useful,
19: * but WITHOUT ANY WARRANTY; without even the implied warranty of
20: * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21: * GNU Affero General Public License for more details.
22: *
23: * You should have received a copy of the GNU Affero General Public License
24: * along with FreeM. If not, see <https://www.gnu.org/licenses/>.
25: *
1.3 ! snw 26: * $Log$
! 27: *
! 28: * SPDX-FileCopyrightText: (C) 2025 Coherent Logic Development LLC
! 29: * SPDX-License-Identifier: AGPL-3.0-or-later
1.1 snw 30: **/
31:
32: #include <stdlib.h>
33: #include <stdio.h>
34: #include <string.h>
35:
36: #include "mpsdef.h"
37: #include "mref.h"
38: #include "ssvn_zrpi.h"
39:
40: #if defined(HAVE_WIRINGPI_H)
41: # include <wiringPi.h>
42: #endif
43:
44: int rpi_pinmode[RPI_PINCOUNT];
45:
46: void ssvn_zrpi_init (void)
47: {
48: register int i;
49:
50: #if defined(HAVE_WIRINGPI_H)
51:
52: wiringPiSetup ();
53:
54: for (i = 0; i < RPI_PINCOUNT; i++) {
55: pinMode (i, INPUT);
56: rpi_pinmode[i] = INPUT;
57: }
58:
59: #endif
60:
61: }
62:
63: void ssvn_zrpi (short action, char *key, char *data)
64: {
65: int pin;
66:
67: freem_ref_t *ref = (freem_ref_t *) malloc (sizeof (freem_ref_t));
68: char *kbuf = (char *) malloc (STRLEN * sizeof (char));
69: char *verb = (char *) malloc (STRLEN * sizeof (char));
70:
71: NULLPTRCHK(ref,"ssvn_zrpi");
72: NULLPTRCHK(kbuf,"ssvn_zrpi");
73: NULLPTRCHK(verb,"ssvn_zrpi");
74:
75: #if !defined(HAVE_WIRINGPI_H)
76:
77: /* not on a Raspberry Pi */
78:
79: *data = EOL;
80: merr_raise (NORPI);
81:
82: goto done;
83:
84: #else
85:
86: mref_init (ref, MREF_RT_SSVN, "");
87: internal_to_mref (ref, key);
88:
89: stcpy (kbuf, key);
90:
91:
92: if (strcmp (ref->subscripts[0], "INITIALIZE") == 0) {
93:
94: ssvn_zrpi_init ();
95:
96: *data = EOL;
97: merr_raise (OK);
98:
99: goto done;
100:
101: }
102:
103: if (strcmp (ref->subscripts[0], "GPIO") != 0) {
104: merr_raise (INVREF);
105: goto done;
106: }
107:
108: if (ref->subscript_count < 3) {
109: merr_raise (INVREF);
110: goto done;
111: }
112:
113: pin = atol (ref->subscripts[1]);
114: strncpy (verb, ref->subscripts[2], 255);
115:
116: if (pin < 0 || pin > RPI_PINCOUNT) {
117: merr_raise (INVREF);
118: goto done;
119: }
120:
121: switch (action) {
122:
123:
124: case get_sym:
125:
126: if (strcmp (verb, "MODE") == 0) {
127:
128: switch (rpi_pinmode[pin]) {
129:
130: case INPUT:
131: sprintf (data, "INPUT\201");
132: break;
133:
134: case OUTPUT:
135: sprintf (data, "OUTPUT\201");
136: break;
137:
138: case PWM_OUTPUT:
139: sprintf (data, "PWM_OUTPUT\201");
140: break;
141:
142: case GPIO_CLOCK:
143: sprintf (data, "GPIO_CLOCK\201");
144: break;
145: }
146:
147:
148: }
149: else if (strcmp (verb, "DIGITAL") == 0) {
150:
151: sprintf (data, "%d\201", digitalRead (pin));
152: break;
153:
154: }
155: else if (strcmp (verb, "ANALOG") == 0) {
156:
157: sprintf (data, "%d\201", analogRead (pin));
158: break;
159:
160: }
161: else {
162: merr_raise (INVREF);
163: goto done;
164: }
165:
166: goto done;
167:
168:
169: case set_sym:
170:
171:
172: if (strcmp (verb, "MODE") == 0) {
173:
174: if (stcmp (data, "INPUT\201") == 0) {
175: pinMode (pin, INPUT);
176: rpi_pinmode[pin] = INPUT;
177: }
178: else if (stcmp (data, "OUTPUT\201") == 0) {
179: pinMode (pin, OUTPUT);
180: rpi_pinmode[pin] = OUTPUT;
181: }
182: else if (stcmp (data, "PWM_OUTPUT\201") == 0) {
183: pinMode (pin, PWM_OUTPUT);
184: rpi_pinmode[pin] = PWM_OUTPUT;
185: }
186: else if (stcmp (data, "GPIO_CLOCK\201") == 0) {
187: pinMode (pin, GPIO_CLOCK);
188: rpi_pinmode[pin] = GPIO_CLOCK;
189: }
190: else {
191: merr_raise (INVREF);
192: goto done;
193: }
194:
195: goto done;
196:
197: }
198: else if (strcmp (verb, "DIGITAL") == 0) {
199:
200: char dta[255];
201: int val;
202:
203: stcpy (dta, data);
204: stcnv_m2c (dta);
205:
206: val = atoi (dta);
207:
208: switch (val) {
209:
210: case 0:
211: digitalWrite (pin, LOW);
212: goto done;
213:
214: case 1:
215: digitalWrite (pin, HIGH);
216: goto done;
217:
218: default:
219: merr_raise (INVREF);
220: goto done;
221:
222: }
223:
224: goto done;
225:
226: }
227: else if (strcmp (verb, "ANALOG") == 0) {
228:
229: char dta[255];
230: int val;
231:
232: stcpy (dta, data);
233: stcnv_m2c (dta);
234:
235: val = atoi (dta);
236:
237: if (val < 0 || val > 1024) {
238: merr_raise (INVREF);
239: goto done;
240: }
241:
242: analogWrite (pin, val);
243:
244: goto done;
245:
246: }
247: else {
248: merr_raise (INVREF);
249: goto done;
250: }
251:
252: goto done;
253:
254:
255: default:
256:
257: merr_raise (INVREF);
258: goto done;
259:
260: break;
261:
262: }
263:
264: #endif
265:
266:
267: done:
268:
269: free (ref);
270: free (kbuf);
271: free (verb);
272:
273: return;
274:
275: }
FreeBSD-CVSweb <freebsd-cvsweb@FreeBSD.org>
![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to ssvn_zrpi.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Coherent Logic Development] / freem / src