1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
|
/* $Id: drv_generic_gpio.c,v 1.1 2005/12/18 16:18:36 reinelt Exp $
*
* generic driver helper for GPO's
*
* Copyright (C) 2005 Michael Reinelt <reinelt@eunet.at>
* Copyright (C) 2005 The LCD4Linux Team <lcd4linux-devel@users.sourceforge.net>
*
* This file is part of LCD4Linux.
*
* LCD4Linux is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2, or (at your option)
* any later version.
*
* LCD4Linux is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
*
*
* $Log: drv_generic_gpio.c,v $
* Revision 1.1 2005/12/18 16:18:36 reinelt
* GPO's added again
*
*/
/*
*
* exported variables:
*
* extern int GPIS, GPOS; number of Inputs and Outputs
*
*
* these functions must be implemented by the real driver:
*
* void (*drv_generic_gpio_real_set) (const int num, const int val);
* sets GPO num to val
*
* int (*drv_generic_gpio_real_get) (const int num);
* reads GPI num
*
*
* exported fuctions:
*
* int drv_generic_gpio_init(const char *section, const char *driver);
* initializes the generic GPIO driver
*
* int drv_generic_gpio_clear(void);
* resets all GPO's
*
* int drv_generic_gpio_draw(WIDGET * W);
* 'draws' GPO widget
* calls drv_generic_gpio_real_set()
*
* int drv_generic_gpio_quit(void);
* closes the generic GPIO driver
*
*/
#include "config.h"
#include <stdio.h>
#include "debug.h"
#include "plugin.h"
#include "widget.h"
#include "widget_gpo.h"
#include "drv_generic_gpio.h"
#ifdef WITH_DMALLOC
#include <dmalloc.h>
#endif
#define MAX_GPOS 32
static char *Section = NULL;
static char *Driver = NULL;
static int GPO[MAX_GPOS];
int GPOS = 0;
int GPIS = 0;
int drv_generic_gpio_init(const char *section, const char *driver)
{
WIDGET_CLASS wc;
Section = (char *) section;
Driver = (char *) driver;
if (GPIS <= 0 && GPOS <= 0) {
error("%s: Huh? gpio_init(GPIS=%d, GPOS=%d)", Driver, GPIS, GPOS);
}
/* reset all GPO's */
drv_generic_gpio_clear();
/* register gpo widget */
wc = Widget_GPO;
wc.draw = drv_generic_gpio_draw;
widget_register(&wc);
/* register plugins */
/* Fixme */
return 0;
}
int drv_generic_gpio_clear(void)
{
int i;
/* init GPO bufferr */
for (i = 0; i < MAX_GPOS; i++) {
GPO[i] = 0;
}
/* really clear GPO's */
for (i = 0; i < GPOS; i++) {
drv_generic_gpio_real_set(i, 0);
}
return 0;
}
int drv_generic_gpio_draw(WIDGET * W)
{
WIDGET_GPO *gpo = W->data;
int num = gpo->num;
int val = gpo->val;
if (num < 0 || num >= GPOS) {
error("%s: gpio_draw(%d): GPO out of range (0..%d)", Driver, num + 1, GPOS);
return -1;
}
if (GPO[num] != val) {
drv_generic_gpio_real_set(num, val);
GPO[num] = val;
}
return 0;
}
int drv_generic_gpio_quit(void)
{
return 0;
}
|
