diff options
Diffstat (limited to 'drv_generic_gpio.c')
| -rw-r--r-- | drv_generic_gpio.c | 246 |
1 files changed, 246 insertions, 0 deletions
diff --git a/drv_generic_gpio.c b/drv_generic_gpio.c new file mode 100644 index 0000000..391d196 --- /dev/null +++ b/drv_generic_gpio.c @@ -0,0 +1,246 @@ +/* $Id: drv_generic_gpio.c 1049 2009-11-03 04:59:04Z peterbailey $ + * $URL: https://ssl.bulix.org/svn/lcd4linux/trunk/drv_generic_gpio.c $ + * + * generic driver helper for GPO's + * + * Copyright (C) 2005 Michael Reinelt <michael@reinelt.co.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. + * + */ + +/* + * + * exported variables: + * + * extern int GPIS, GPOS; number of Inputs and Outputs + * + * + * these functions must be implemented by the real driver: + * + * int (*drv_generic_gpio_real_set) (const int num, const int val); + * sets GPO num to val, returns the actual value + * + * 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_get (const int num) + * returns value og GPI #num + * + * 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_GPIS 32 +#define MAX_GPOS 32 + + +static char *Section = NULL; +static char *Driver = NULL; + +static int GPI[MAX_GPIS]; +static int GPO[MAX_GPOS]; + +int GPOS = 0; +int GPIS = 0; + +int (*drv_generic_gpio_real_set) () = NULL; +int (*drv_generic_gpio_real_get) () = NULL; + + +static void drv_generic_gpio_plugin_gpi(RESULT * result, RESULT * arg1) +{ + int num; + double val; + + num = R2N(arg1); + + if (num <= 0 || num > GPIS) { + error("%s::GPI(%d): GPI out of range (1..%d)", Driver, num, GPIS); + SetResult(&result, R_STRING, ""); + return; + } + + val = drv_generic_gpio_get(num - 1); + SetResult(&result, R_NUMBER, &val); +} + + +static void drv_generic_gpio_plugin_gpo(RESULT * result, const int argc, RESULT * argv[]) +{ + int num, val; + double gpo; + + switch (argc) { + case 1: + num = R2N(argv[0]); + if (num <= 0 || num > GPOS) { + error("%s::GPO(%d): GPO out of range (1..%d)", Driver, num, GPOS); + SetResult(&result, R_STRING, ""); + return; + } + gpo = GPO[num - 1]; + SetResult(&result, R_NUMBER, &gpo); + break; + case 2: + num = R2N(argv[0]); + val = R2N(argv[1]); + if (num <= 0 || num > GPOS) { + error("%s::GPO(%d): GPO out of range (1..%d)", Driver, num, GPOS); + SetResult(&result, R_STRING, ""); + return; + } + if (GPO[num - 1] != val) { + if (drv_generic_gpio_real_set) + GPO[num - 1] = drv_generic_gpio_real_set(num - 1, val); + } + gpo = GPO[num - 1]; + SetResult(&result, R_NUMBER, &gpo); + break; + default: + error("%s::GPO(): wrong number of parameters", Driver); + SetResult(&result, R_STRING, ""); + } +} + + +int drv_generic_gpio_init(const char *section, const char *driver) +{ + WIDGET_CLASS wc; + + Section = (char *) section; + Driver = (char *) driver; + + info("%s: using %d GPI's and %d GPO's", 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 */ + AddFunction("LCD::GPI", 1, drv_generic_gpio_plugin_gpi); + AddFunction("LCD::GPO", -1, drv_generic_gpio_plugin_gpo); + + return 0; +} + + +int drv_generic_gpio_clear(void) +{ + int i; + + /* clear GPI buffer */ + for (i = 0; i < MAX_GPIS; i++) { + GPI[i] = 0; + } + + /* clear GPO buffer */ + for (i = 0; i < MAX_GPOS; i++) { + GPO[i] = 0; + } + + /* really clear GPO's */ + for (i = 0; i < GPOS; i++) { + if (drv_generic_gpio_real_set) + GPO[i] = drv_generic_gpio_real_set(i, 0); + + } + + return 0; +} + + +int drv_generic_gpio_get(const int num) +{ + int val = 0; + + if (num < 0 || num >= GPIS) { + error("%s: gpio_get(%d): GPI out of range (0..%d)", Driver, num + 1, GPIS); + return -1; + } + + if (drv_generic_gpio_real_get) + val = drv_generic_gpio_real_get(num); + + GPI[num] = val; + + return val; +} + + +int drv_generic_gpio_draw(WIDGET * W) +{ + WIDGET_GPO *gpo = W->data; + int num, val; + + num = W->row; + val = P2N(&gpo->expression); + + 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) { + if (drv_generic_gpio_real_set) + GPO[num] = drv_generic_gpio_real_set(num, val); + } + + return 0; +} + + +int drv_generic_gpio_quit(void) +{ + info("%s: shutting down GPIO driver.", Driver); + drv_generic_gpio_clear(); + return 0; +} |