diff options
author | reinelt <reinelt@3ae390bd-cb1e-0410-b409-cd5a39f66f1f> | 2005-12-20 07:07:44 +0000 |
---|---|---|
committer | reinelt <reinelt@3ae390bd-cb1e-0410-b409-cd5a39f66f1f> | 2005-12-20 07:07:44 +0000 |
commit | 213594414361e470ef3ac1b655091934a129094f (patch) | |
tree | ab40f6618a5cf52ca1a5d95a2d985ac4194334eb /drv_generic_gpio.c | |
parent | da2e1bd82366d5d75d8e67c18179f76b9baf7a65 (diff) | |
download | lcd4linux-213594414361e470ef3ac1b655091934a129094f.tar.gz |
[lcd4linux @ 2005-12-20 07:07:43 by reinelt]
further work on GPO's, HD44780 GPO support
git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@604 3ae390bd-cb1e-0410-b409-cd5a39f66f1f
Diffstat (limited to 'drv_generic_gpio.c')
-rw-r--r-- | drv_generic_gpio.c | 53 |
1 files changed, 46 insertions, 7 deletions
diff --git a/drv_generic_gpio.c b/drv_generic_gpio.c index 4e3a811..c4bf69b 100644 --- a/drv_generic_gpio.c +++ b/drv_generic_gpio.c @@ -1,4 +1,4 @@ -/* $Id: drv_generic_gpio.c,v 1.1 2005/12/18 16:18:36 reinelt Exp $ +/* $Id: drv_generic_gpio.c,v 1.2 2005/12/20 07:07:44 reinelt Exp $ * * generic driver helper for GPO's * @@ -23,6 +23,9 @@ * * * $Log: drv_generic_gpio.c,v $ + * Revision 1.2 2005/12/20 07:07:44 reinelt + * further work on GPO's, HD44780 GPO support + * * Revision 1.1 2005/12/18 16:18:36 reinelt * GPO's added again * @@ -37,8 +40,8 @@ * * 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_set) (const int num, const int val); + * sets GPO num to val, returns the actal value * * int (*drv_generic_gpio_real_get) (const int num); * reads GPI num @@ -88,6 +91,43 @@ int GPOS = 0; int GPIS = 0; +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) { + 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; @@ -109,7 +149,7 @@ int drv_generic_gpio_init(const char *section, const char *driver) /* register plugins */ - /* Fixme */ + AddFunction("LCD::GPO", -1, drv_generic_gpio_plugin_gpo); return 0; } @@ -126,7 +166,7 @@ int drv_generic_gpio_clear(void) /* really clear GPO's */ for (i = 0; i < GPOS; i++) { - drv_generic_gpio_real_set(i, 0); + GPO[i] = drv_generic_gpio_real_set(i, 0); } return 0; @@ -145,8 +185,7 @@ int drv_generic_gpio_draw(WIDGET * W) } if (GPO[num] != val) { - drv_generic_gpio_real_set(num, val); - GPO[num] = val; + GPO[num] = drv_generic_gpio_real_set(num, val); } return 0; |