From dbf5d92605a9db10e3e3cb154d03a515c5d5c5af Mon Sep 17 00:00:00 2001 From: reinelt Date: Sun, 8 May 2005 04:32:45 +0000 Subject: [lcd4linux @ 2005-05-08 04:32:43 by reinelt] CodingStyle added and applied git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@547 3ae390bd-cb1e-0410-b409-cd5a39f66f1f --- drv_BeckmannEgle.c | 1008 +++++++++++++++++++++++++++------------------------- 1 file changed, 514 insertions(+), 494 deletions(-) (limited to 'drv_BeckmannEgle.c') diff --git a/drv_BeckmannEgle.c b/drv_BeckmannEgle.c index cb16960..07a6ca7 100644 --- a/drv_BeckmannEgle.c +++ b/drv_BeckmannEgle.c @@ -1,4 +1,4 @@ -/* $Id: drv_BeckmannEgle.c,v 1.14 2005/01/18 06:30:22 reinelt Exp $ +/* $Id: drv_BeckmannEgle.c,v 1.15 2005/05/08 04:32:44 reinelt Exp $ * * driver for Beckmann+Egle "Mini Terminals" and "Compact Terminals" * Copyright (C) 2000 Michael Reinelt @@ -22,6 +22,9 @@ * * * $Log: drv_BeckmannEgle.c,v $ + * Revision 1.15 2005/05/08 04:32:44 reinelt + * CodingStyle added and applied + * * Revision 1.14 2005/01/18 06:30:22 reinelt * added (C) to all copyright statements * @@ -119,39 +122,39 @@ #define ESC "\033" -static char Name[]="Beckmann+Egle"; +static char Name[] = "Beckmann+Egle"; typedef struct { - char *name; - int rows; - int cols; - int protocol; - int type; + char *name; + int rows; + int cols; + int protocol; + int type; } MODEL; static MODEL Models[] = { - /* MultiTerminals */ - { "MT16x1", 1, 16, 1, 0 }, - { "MT16x2", 2, 16, 1, 1 }, - { "MT16x4", 4, 16, 1, 2 }, - { "MT20x1", 1, 20, 1, 3 }, - { "MT20x2", 2, 20, 1, 4 }, - { "MT20x4", 4, 20, 1, 5 }, - { "MT24x1", 1, 24, 1, 6 }, - { "MT24x2", 2, 24, 1, 7 }, - { "MT32x1", 1, 32, 1, 8 }, - { "MT32x2", 2, 32, 1, 9 }, - { "MT40x1", 1, 40, 1, 10 }, - { "MT40x2", 2, 40, 1, 11 }, - { "MT40x4", 4, 40, 1, 12 }, - - /* CompactTerminal */ - { "CT20x4", 4, 20, 2, 0 }, - - { NULL, 0, 0, 0, 0 }, + /* MultiTerminals */ + {"MT16x1", 1, 16, 1, 0}, + {"MT16x2", 2, 16, 1, 1}, + {"MT16x4", 4, 16, 1, 2}, + {"MT20x1", 1, 20, 1, 3}, + {"MT20x2", 2, 20, 1, 4}, + {"MT20x4", 4, 20, 1, 5}, + {"MT24x1", 1, 24, 1, 6}, + {"MT24x2", 2, 24, 1, 7}, + {"MT32x1", 1, 32, 1, 8}, + {"MT32x2", 2, 32, 1, 9}, + {"MT40x1", 1, 40, 1, 10}, + {"MT40x2", 2, 40, 1, 11}, + {"MT40x4", 4, 40, 1, 12}, + + /* CompactTerminal */ + {"CT20x4", 4, 20, 2, 0}, + + {NULL, 0, 0, 0, 0}, }; @@ -164,378 +167,395 @@ static int Protocol; /*** hardware dependant functions ***/ /****************************************/ -static void drv_BuE_clear (void) +static void drv_BuE_clear(void) { - switch (Protocol) { - case 1: - drv_generic_serial_write (ESC "&#", 3); /* clear display */ - break; - case 2: - drv_generic_serial_write (ESC "LL", 3); /* clear display */ - break; - } + switch (Protocol) { + case 1: + drv_generic_serial_write(ESC "&#", 3); /* clear display */ + break; + case 2: + drv_generic_serial_write(ESC "LL", 3); /* clear display */ + break; + } } -static void drv_BuE_MT_write (const int row, const int col, const char *data, const int len) +static void drv_BuE_MT_write(const int row, const int col, const char *data, const int len) { - char cmd[] = ESC "[y;xH"; + char cmd[] = ESC "[y;xH"; - cmd[2] = (char)row; - cmd[4] = (char)col; + cmd[2] = (char) row; + cmd[4] = (char) col; - drv_generic_serial_write (cmd, 6); - drv_generic_serial_write (data, len); + drv_generic_serial_write(cmd, 6); + drv_generic_serial_write(data, len); } -static void drv_BuE_MT_defchar (const int ascii, const unsigned char *matrix) +static void drv_BuE_MT_defchar(const int ascii, const unsigned char *matrix) { - int i; - char cmd[22] = ESC "&T"; /* enter transparent mode */ + int i; + char cmd[22] = ESC "&T"; /* enter transparent mode */ - cmd[3] = '\0'; /* write cmd */ - cmd[4] = 0x40|8*ascii; /* write CGRAM */ + cmd[3] = '\0'; /* write cmd */ + cmd[4] = 0x40 | 8 * ascii; /* write CGRAM */ - for (i = 0; i < 8; i++) { - cmd[2*i+5] = '\1'; /* write data */ - cmd[2*i+6] = matrix[i] & 0x1f; /* character bitmap */ - } - cmd[21] = '\377'; /* leave transparent mode */ + for (i = 0; i < 8; i++) { + cmd[2 * i + 5] = '\1'; /* write data */ + cmd[2 * i + 6] = matrix[i] & 0x1f; /* character bitmap */ + } + cmd[21] = '\377'; /* leave transparent mode */ - drv_generic_serial_write (cmd, 22); + drv_generic_serial_write(cmd, 22); } -static void drv_BuE_CT_write (const int row, const int col, const char *data, const int len) +static void drv_BuE_CT_write(const int row, const int col, const char *data, const int len) { - char cmd[] = ESC "LCzs\001"; - cmd[3] = (char)row + 1; - cmd[4] = (char)col + 1; + char cmd[] = ESC "LCzs\001"; + cmd[3] = (char) row + 1; + cmd[4] = (char) col + 1; - drv_generic_serial_write (cmd, 6); - drv_generic_serial_write (data, len); + drv_generic_serial_write(cmd, 6); + drv_generic_serial_write(data, len); } -static void drv_BuE_CT_defchar (const int ascii, const unsigned char *matrix) +static void drv_BuE_CT_defchar(const int ascii, const unsigned char *matrix) { - int i; - char cmd[13] = ESC "LZ"; /* set custom char */ + int i; + char cmd[13] = ESC "LZ"; /* set custom char */ - /* number of user-defined char (0..7) */ - cmd[3] = (char) ascii - CHAR0; + /* number of user-defined char (0..7) */ + cmd[3] = (char) ascii - CHAR0; - /* ASCII code to replace */ - cmd[4] = (char) ascii; - - for (i = 0; i < 8; i++) { - cmd[i+5] = matrix[i] & 0x1f; - } + /* ASCII code to replace */ + cmd[4] = (char) ascii; - drv_generic_serial_write (cmd, 13); + for (i = 0; i < 8; i++) { + cmd[i + 5] = matrix[i] & 0x1f; + } + + drv_generic_serial_write(cmd, 13); } -static int drv_BuE_CT_contrast (int contrast) +static int drv_BuE_CT_contrast(int contrast) { - static char Contrast = 7; - char cmd[4] = ESC "LKn"; + static char Contrast = 7; + char cmd[4] = ESC "LKn"; + + /* -1 is used to query the current contrast */ + if (contrast == -1) + return Contrast; - /* -1 is used to query the current contrast */ - if (contrast == -1) return Contrast; + if (contrast < 0) + contrast = 0; + if (contrast > 15) + contrast = 15; + Contrast = contrast; - if (contrast < 0 ) contrast = 0; - if (contrast > 15) contrast = 15; - Contrast = contrast; - - cmd[3] = Contrast; + cmd[3] = Contrast; - drv_generic_serial_write (cmd, 4); - - return Contrast; + drv_generic_serial_write(cmd, 4); + + return Contrast; } -static int drv_BuE_CT_backlight (int backlight) +static int drv_BuE_CT_backlight(int backlight) { - static char Backlight=0; - char cmd[4] = ESC "LBn"; + static char Backlight = 0; + char cmd[4] = ESC "LBn"; + + /* -1 is used to query the current backlight */ + if (backlight == -1) + return Backlight; - /* -1 is used to query the current backlight */ - if (backlight == -1) return Backlight; + if (backlight < 0) + backlight = 0; + if (backlight > 1) + backlight = 1; + Backlight = backlight; - if (backlight < 0) backlight = 0; - if (backlight > 1) backlight = 1; - Backlight = backlight; - - cmd[3] = Backlight; + cmd[3] = Backlight; - drv_generic_serial_write (cmd, 4); + drv_generic_serial_write(cmd, 4); - return Backlight; + return Backlight; } -static int drv_BuE_CT_gpo (int num, int val) +static int drv_BuE_CT_gpo(int num, int val) { - static int GPO[8] = { -1, -1, -1, -1, -1, -1, -1, -1 }; - char cmd[4] = ESC "Pnx"; - - if (num < 0) num = 0; - if (num > 7) num = 7; - - /* -1 is used to query the current GPO */ - if (val == -1) return GPO[num]; - - if (val < 0 ) val = 0; - if (val > 255) val = 255; - GPO[num] = val; - - cmd[2] = (char)num; - cmd[3] = (char)val; - - drv_generic_serial_write (cmd, 4); - - return GPO[num]; + static int GPO[8] = { -1, -1, -1, -1, -1, -1, -1, -1 }; + char cmd[4] = ESC "Pnx"; + + if (num < 0) + num = 0; + if (num > 7) + num = 7; + + /* -1 is used to query the current GPO */ + if (val == -1) + return GPO[num]; + + if (val < 0) + val = 0; + if (val > 255) + val = 255; + GPO[num] = val; + + cmd[2] = (char) num; + cmd[3] = (char) val; + + drv_generic_serial_write(cmd, 4); + + return GPO[num]; } -static int drv_BuE_CT_gpi (int num) +static int drv_BuE_CT_gpi(int num) { - char cmd[4] = ESC "?Pn"; - char buffer[4]; - - if (num < 0) num = 0; - if (num > 7) num = 7; - - cmd[3] = (char)num; - drv_generic_serial_write (cmd, 4); - - usleep (10000); - - if (drv_generic_serial_read (buffer, 4) != 4) { - error ("%s: error reading port %d", Name, num); - return -1; - } - - return buffer[3]; + char cmd[4] = ESC "?Pn"; + char buffer[4]; + + if (num < 0) + num = 0; + if (num > 7) + num = 7; + + cmd[3] = (char) num; + drv_generic_serial_write(cmd, 4); + + usleep(10000); + + if (drv_generic_serial_read(buffer, 4) != 4) { + error("%s: error reading port %d", Name, num); + return -1; + } + + return buffer[3]; } -static int drv_BuE_CT_adc (void) +static int drv_BuE_CT_adc(void) { - char buffer[4]; - - drv_generic_serial_write (ESC "?A", 3); - - usleep (10000); - - if ((drv_generic_serial_read (buffer, 4) != 4) || - (buffer[0] != 'A') || - (buffer[1] != ':') - ) { - error ("%s: error reading ADC", Name); - return -1; - } - - /* 10 bit value: 8 bit high, 2 bit low */ - return 4 * (unsigned char) buffer[2] + (unsigned char) buffer[3]; + char buffer[4]; + + drv_generic_serial_write(ESC "?A", 3); + + usleep(10000); + + if ((drv_generic_serial_read(buffer, 4) != 4) || (buffer[0] != 'A') || (buffer[1] != ':') + ) { + error("%s: error reading ADC", Name); + return -1; + } + + /* 10 bit value: 8 bit high, 2 bit low */ + return 4 * (unsigned char) buffer[2] + (unsigned char) buffer[3]; } -static int drv_BuE_CT_pwm (int val) +static int drv_BuE_CT_pwm(int val) { - static int PWM = -1; - char cmd[4] = ESC "Adm"; - - /* -1 is used to query the current PWM */ - if (val == -1) return PWM; + static int PWM = -1; + char cmd[4] = ESC "Adm"; + + /* -1 is used to query the current PWM */ + if (val == -1) + return PWM; - if (val < 0) val = 0; - if (val > 255) val = 255; - PWM = val; + if (val < 0) + val = 0; + if (val > 255) + val = 255; + PWM = val; - cmd[2] = (char) val; - cmd[3] = val == 0 ? 1 : 2; - drv_generic_serial_write (cmd, 4); + cmd[2] = (char) val; + cmd[3] = val == 0 ? 1 : 2; + drv_generic_serial_write(cmd, 4); - return val; + return val; } -static int drv_BuE_MT_start (const char *section) +static int drv_BuE_MT_start(const char *section) { - char cmd[] = ESC "&sX"; - - /* CSTOPB: 2 stop bits */ - if (drv_generic_serial_open(section, Name, CSTOPB) < 0) return -1; - - cmd[4] = Models[Model].type; - drv_generic_serial_write (cmd, 4); /* select display type */ - drv_generic_serial_write (ESC "&D", 3); /* cursor off */ - - return 0; + char cmd[] = ESC "&sX"; + + /* CSTOPB: 2 stop bits */ + if (drv_generic_serial_open(section, Name, CSTOPB) < 0) + return -1; + + cmd[4] = Models[Model].type; + drv_generic_serial_write(cmd, 4); /* select display type */ + drv_generic_serial_write(ESC "&D", 3); /* cursor off */ + + return 0; } -static int drv_BuE_CT_start (const char *section) +static int drv_BuE_CT_start(const char *section) { - char buffer[16]; - char *size; - int i, len; - - if (drv_generic_serial_open(section, Name, 0) < 0) return -1; - + char buffer[16]; + char *size; + int i, len; + + if (drv_generic_serial_open(section, Name, 0) < 0) + return -1; + #if 0 - /* restart terminal */ - drv_generic_serial_write (ESC "Kr", 3); - usleep(10000); + /* restart terminal */ + drv_generic_serial_write(ESC "Kr", 3); + usleep(10000); #endif - - /* Fixme: the CT does not return a serial number in byte mode */ - /* set parameter mode 'decimal' */ - drv_generic_serial_write (ESC "KM\073", 4); - - /* read version */ - drv_generic_serial_write (ESC "?V", 3); - usleep(100000); - if ((len = drv_generic_serial_read (buffer, -sizeof(buffer))) > 0) { - int v, r, s; - if (sscanf(buffer, "V:%d.%d,%d;", &v, &r, &s) != 3) { - error ("%s: error parsing display identification <%*s>", Name, len, buffer); - } else { - info ("%s: display identified as version %d.%d, S/N %d", Name, v, r, s); + + /* Fixme: the CT does not return a serial number in byte mode */ + /* set parameter mode 'decimal' */ + drv_generic_serial_write(ESC "KM\073", 4); + + /* read version */ + drv_generic_serial_write(ESC "?V", 3); + usleep(100000); + if ((len = drv_generic_serial_read(buffer, -sizeof(buffer))) > 0) { + int v, r, s; + if (sscanf(buffer, "V:%d.%d,%d;", &v, &r, &s) != 3) { + error("%s: error parsing display identification <%*s>", Name, len, buffer); + } else { + info("%s: display identified as version %d.%d, S/N %d", Name, v, r, s); + } } - } - - /* set parameter mode 'byte' */ - drv_generic_serial_write (ESC "KM\072", 4); - - /* the CT20x4 can control smaller displays, too */ - size = cfg_get(section, "Size", NULL); - if (size != NULL && *size != '\0') { - int r, c; - char cmd[6] = ESC "LArc"; - if (sscanf(size, "%dx%d", &c, &r) != 2 || r < 1 || c < 1) { - error ("%s: bad %s.Size '%s' from %s", Name, section, size, cfg_source()); - return -1; + + /* set parameter mode 'byte' */ + drv_generic_serial_write(ESC "KM\072", 4); + + /* the CT20x4 can control smaller displays, too */ + size = cfg_get(section, "Size", NULL); + if (size != NULL && *size != '\0') { + int r, c; + char cmd[6] = ESC "LArc"; + if (sscanf(size, "%dx%d", &c, &r) != 2 || r < 1 || c < 1) { + error("%s: bad %s.Size '%s' from %s", Name, section, size, cfg_source()); + return -1; + } + info("%s: display size: %d rows %d columns", Name, r, c); + /* set display size */ + cmd[3] = (char) r; + cmd[4] = (char) c; + drv_generic_serial_write(cmd, 5); + DCOLS = c; + DROWS = r; } - info ("%s: display size: %d rows %d columns", Name, r, c); - /* set display size */ - cmd[3] = (char) r; - cmd[4] = (char) c; - drv_generic_serial_write (cmd, 5); - DCOLS = c; - DROWS = r; - } - - /* set contrast */ - if (cfg_number(section, "Contrast", 7, 0, 15, &i) > 0) { - drv_BuE_CT_contrast(i); - } - - /* set backlight */ - if (cfg_number(section, "Backlight", 0, 0, 1, &i) > 0) { - drv_BuE_CT_backlight(i); - } - - - /* identify modules */ - - for (i = 0; i < 8; i++) { - char cmd[5] = ESC "K?Pn"; - cmd[4] = (char)i; - drv_generic_serial_write (cmd, 5); /* query I/O port */ - usleep(10000); - if ((len = drv_generic_serial_read (buffer, 4)) == 4) { - char *type = NULL; - if (i == 0) { - if( buffer[3] == 8) { - /* internal port */ - type = "CT 20x4 internal port"; + + /* set contrast */ + if (cfg_number(section, "Contrast", 7, 0, 15, &i) > 0) { + drv_BuE_CT_contrast(i); + } + + /* set backlight */ + if (cfg_number(section, "Backlight", 0, 0, 1, &i) > 0) { + drv_BuE_CT_backlight(i); + } + + + /* identify modules */ + + for (i = 0; i < 8; i++) { + char cmd[5] = ESC "K?Pn"; + cmd[4] = (char) i; + drv_generic_serial_write(cmd, 5); /* query I/O port */ + usleep(10000); + if ((len = drv_generic_serial_read(buffer, 4)) == 4) { + char *type = NULL; + if (i == 0) { + if (buffer[3] == 8) { + /* internal port */ + type = "CT 20x4 internal port"; + } else { + error("%s: internal error: port 0 type %d should be type 8", Name, buffer[3]); + continue; + } + } else { + switch (buffer[3]) { + case 1: /* Key Module */ + type = "XM-KEY-2x4-LED"; + break; + case 8: /* I/O Module */ + type = "XM-IO8-T"; + break; + case 9: /* I/O Module */ + type = "XM-IO4-R"; + break; + case 15: /* nothing */ + continue; + default: /* unhandled */ + type = NULL; + break; + } + } + if (type != NULL) { + info("%s: Port %d: %s", Name, i, type); + } else { + error("%s: internal error: port % unknown type %d", Name, i, cmd[3]); + } } else { - error ("%s: internal error: port 0 type %d should be type 8", Name, buffer[3]); - continue; + error("%s: error fetching type of port %d", Name, i); } - } else { - switch (buffer[3]) { - case 1: /* Key Module */ - type = "XM-KEY-2x4-LED"; - break; - case 8: /* I/O Module */ - type = "XM-IO8-T"; - break; - case 9: /* I/O Module */ - type = "XM-IO4-R"; - break; - case 15: /* nothing */ - continue; - default: /* unhandled */ - type = NULL; - break; - } - } - if (type != NULL) { - info ("%s: Port %d: %s", Name, i, type); - } else { - error ("%s: internal error: port % unknown type %d", Name, i, cmd[3]); - } - } else { - error ("%s: error fetching type of port %d", Name, i); } - } - return 0; + return 0; } -static int drv_BuE_start (const char *section) +static int drv_BuE_start(const char *section) { - int i, ret; - char *model; - - model = cfg_get(section, "Model", NULL); - if (model == NULL && *model == '\0') { - error ("%s: no '%s.Model' entry from %s", Name, section, cfg_source()); - return -1; - } - - for (i = 0; Models[i].name != NULL; i++) { - if (strcasecmp(Models[i].name, model) == 0) break; - } - - if (Models[i].name == NULL) { - error ("%s: %s.Model '%s' is unknown from %s", Name, section, model, cfg_source()); - return -1; - } - - Model = i; - Protocol = Models[Model].protocol; - - info ("%s: using model '%s'", Name, Models[Model].name); - - /* initialize global variables */ - DROWS = Models[Model].rows; - DCOLS = Models[Model].cols; - - ret = 0; - switch (Protocol) { - case 1: - ret = drv_BuE_MT_start(section); - break; - case 2: - ret = drv_BuE_CT_start(section); - break; - } - if (ret != 0) { - return ret; - } - - drv_BuE_clear(); - - return 0; + int i, ret; + char *model; + + model = cfg_get(section, "Model", NULL); + if (model == NULL && *model == '\0') { + error("%s: no '%s.Model' entry from %s", Name, section, cfg_source()); + return -1; + } + + for (i = 0; Models[i].name != NULL; i++) { + if (strcasecmp(Models[i].name, model) == 0) + break; + } + + if (Models[i].name == NULL) { + error("%s: %s.Model '%s' is unknown from %s", Name, section, model, cfg_source()); + return -1; + } + + Model = i; + Protocol = Models[Model].protocol; + + info("%s: using model '%s'", Name, Models[Model].name); + + /* initialize global variables */ + DROWS = Models[Model].rows; + DCOLS = Models[Model].cols; + + ret = 0; + switch (Protocol) { + case 1: + ret = drv_BuE_MT_start(section); + break; + case 2: + ret = drv_BuE_CT_start(section); + break; + } + if (ret != 0) { + return ret; + } + + drv_BuE_clear(); + + return 0; } @@ -543,101 +563,101 @@ static int drv_BuE_start (const char *section) /*** plugins ***/ /****************************************/ -static void plugin_contrast (RESULT *result, const int argc, RESULT *argv[]) +static void plugin_contrast(RESULT * result, const int argc, RESULT * argv[]) { - double contrast; - - switch (argc) { - case 0: - contrast = drv_BuE_CT_contrast(-1); - SetResult(&result, R_NUMBER, &contrast); - break; - case 1: - contrast = drv_BuE_CT_contrast(R2N(argv[0])); - SetResult(&result, R_NUMBER, &contrast); - break; - default: - error ("%s::contrast(): wrong number of parameters", Name); - SetResult(&result, R_STRING, ""); - } + double contrast; + + switch (argc) { + case 0: + contrast = drv_BuE_CT_contrast(-1); + SetResult(&result, R_NUMBER, &contrast); + break; + case 1: + contrast = drv_BuE_CT_contrast(R2N(argv[0])); + SetResult(&result, R_NUMBER, &contrast); + break; + default: + error("%s::contrast(): wrong number of parameters", Name); + SetResult(&result, R_STRING, ""); + } } -static void plugin_backlight (RESULT *result, const int argc, RESULT *argv[]) +static void plugin_backlight(RESULT * result, const int argc, RESULT * argv[]) { - double backlight; - - switch (argc) { - case 0: - backlight = drv_BuE_CT_backlight(-1); - SetResult(&result, R_NUMBER, &backlight); - break; - case 1: - backlight = drv_BuE_CT_backlight(R2N(argv[0])); - SetResult(&result, R_NUMBER, &backlight); - break; - default: - error ("%s::backlight(): wrong number of parameters", Name); - SetResult(&result, R_STRING, ""); - } + double backlight; + + switch (argc) { + case 0: + backlight = drv_BuE_CT_backlight(-1); + SetResult(&result, R_NUMBER, &backlight); + break; + case 1: + backlight = drv_BuE_CT_backlight(R2N(argv[0])); + SetResult(&result, R_NUMBER, &backlight); + break; + default: + error("%s::backlight(): wrong number of parameters", Name); + SetResult(&result, R_STRING, ""); + } } -static void plugin_gpo (RESULT *result, const int argc, RESULT *argv[]) +static void plugin_gpo(RESULT * result, const int argc, RESULT * argv[]) { - double gpo; - - switch (argc) { - case 1: - gpo = drv_BuE_CT_gpo(R2N(argv[0]), -1); - SetResult(&result, R_NUMBER, &gpo); - break; - case 2: - gpo = drv_BuE_CT_gpo(R2N(argv[0]), R2N(argv[1])); - SetResult(&result, R_NUMBER, &gpo); - break; - default: - error ("%s::gpo(): wrong number of parameters", Name); - SetResult(&result, R_STRING, ""); - } + double gpo; + + switch (argc) { + case 1: + gpo = drv_BuE_CT_gpo(R2N(argv[0]), -1); + SetResult(&result, R_NUMBER, &gpo); + break; + case 2: + gpo = drv_BuE_CT_gpo(R2N(argv[0]), R2N(argv[1])); + SetResult(&result, R_NUMBER, &gpo); + break; + default: + error("%s::gpo(): wrong number of parameters", Name); + SetResult(&result, R_STRING, ""); + } } -static void plugin_gpi (RESULT *result, RESULT *arg1) +static void plugin_gpi(RESULT * result, RESULT * arg1) { - double gpi; - - gpi = drv_BuE_CT_gpi(R2N(arg1)); - SetResult(&result, R_NUMBER, &gpi); + double gpi; + + gpi = drv_BuE_CT_gpi(R2N(arg1)); + SetResult(&result, R_NUMBER, &gpi); } -static void plugin_adc (RESULT *result) +static void plugin_adc(RESULT * result) { - double adc; - - adc = drv_BuE_CT_adc(); - SetResult(&result, R_NUMBER, &adc); + double adc; + + adc = drv_BuE_CT_adc(); + SetResult(&result, R_NUMBER, &adc); } -static void plugin_pwm (RESULT *result, const int argc, RESULT *argv[]) +static void plugin_pwm(RESULT * result, const int argc, RESULT * argv[]) { - double pwm; - - switch (argc) { - case 0: - pwm = drv_BuE_CT_pwm(-1); - SetResult(&result, R_NUMBER, &pwm); - break; - case 1: - pwm = drv_BuE_CT_pwm(R2N(argv[0])); - SetResult(&result, R_NUMBER, &pwm); - break; - default: - error ("%s::pwm(): wrong number of parameters", Name); - SetResult(&result, R_STRING, ""); - } + double pwm; + + switch (argc) { + case 0: + pwm = drv_BuE_CT_pwm(-1); + SetResult(&result, R_NUMBER, &pwm); + break; + case 1: + pwm = drv_BuE_CT_pwm(R2N(argv[0])); + SetResult(&result, R_NUMBER, &pwm); + break; + default: + error("%s::pwm(): wrong number of parameters", Name); + SetResult(&result, R_STRING, ""); + } } @@ -656,126 +676,126 @@ static void plugin_pwm (RESULT *result, const int argc, RESULT *argv[]) /* list models */ -int drv_BuE_list (void) +int drv_BuE_list(void) { - int i; - - for (i = 0; Models[i].name != NULL; i++) { - printf ("%s ", Models[i].name); - } - return 0; + int i; + + for (i = 0; Models[i].name != NULL; i++) { + printf("%s ", Models[i].name); + } + return 0; } /* initialize driver & display */ -int drv_BuE_init (const char *section, const int quiet) +int drv_BuE_init(const char *section, const int quiet) { - WIDGET_CLASS wc; - int ret; - - /* start display */ - if ((ret=drv_BuE_start (section)) != 0) { - return ret; - } - - /* display preferences */ - XRES = 5; /* pixel width of one char */ - YRES = 8; /* pixel height of one char */ - CHARS = 8; /* number of user-defineable characters */ - - /* real worker functions */ - switch (Protocol) { - case 1: - CHAR0 = 0; /* ASCII of first user-defineable char */ - GOTO_COST = 6; /* number of bytes a goto command requires */ - drv_generic_text_real_write = drv_BuE_MT_write; - drv_generic_text_real_defchar = drv_BuE_MT_defchar; - break; - case 2: - CHAR0 = 128; /* ASCII of first user-defineable char */ - GOTO_COST = 6; /* number of bytes a goto command requires */ - drv_generic_text_real_write = drv_BuE_CT_write; - drv_generic_text_real_defchar = drv_BuE_CT_defchar; - break; - } - - if (!quiet) { - char buffer[40]; - qprintf(buffer, sizeof(buffer), "%s %s", Name, Models[Model].name); - if (drv_generic_text_greet (buffer, "www.bue.com")) { - sleep (3); - drv_BuE_clear(); + WIDGET_CLASS wc; + int ret; + + /* start display */ + if ((ret = drv_BuE_start(section)) != 0) { + return ret; + } + + /* display preferences */ + XRES = 5; /* pixel width of one char */ + YRES = 8; /* pixel height of one char */ + CHARS = 8; /* number of user-defineable characters */ + + /* real worker functions */ + switch (Protocol) { + case 1: + CHAR0 = 0; /* ASCII of first user-defineable char */ + GOTO_COST = 6; /* number of bytes a goto command requires */ + drv_generic_text_real_write = drv_BuE_MT_write; + drv_generic_text_real_defchar = drv_BuE_MT_defchar; + break; + case 2: + CHAR0 = 128; /* ASCII of first user-defineable char */ + GOTO_COST = 6; /* number of bytes a goto command requires */ + drv_generic_text_real_write = drv_BuE_CT_write; + drv_generic_text_real_defchar = drv_BuE_CT_defchar; + break; } - } - - /* initialize generic text driver */ - if ((ret=drv_generic_text_init(section, Name))!=0) - return ret; - - /* initialize generic icon driver */ - if ((ret=drv_generic_text_icon_init())!=0) - return ret; - - /* initialize generic bar driver */ - if ((ret=drv_generic_text_bar_init(0))!=0) - return ret; - - /* add fixed chars to the bar driver */ - drv_generic_text_bar_add_segment ( 0, 0,255, 32); /* ASCII 32 = blank */ - drv_generic_text_bar_add_segment (255,255,255,255); /* ASCII 255 = block */ - - /* register text widget */ - wc=Widget_Text; - wc.draw=drv_generic_text_draw; - widget_register(&wc); - - /* register icon widget */ - wc=Widget_Icon; - wc.draw=drv_generic_text_icon_draw; - widget_register(&wc); - - /* register bar widget */ - wc=Widget_Bar; - wc.draw=drv_generic_text_bar_draw; - widget_register(&wc); - - /* register plugins */ - AddFunction ("LCD::contrast", -1, plugin_contrast); - AddFunction ("LCD::backlight", -1, plugin_backlight); - AddFunction ("LCD::gpo", -1, plugin_gpo); - AddFunction ("LCD::gpi", 1, plugin_gpi); - AddFunction ("LCD::adc", 0, plugin_adc); - AddFunction ("LCD::pwm", -1, plugin_pwm); - - return 0; + + if (!quiet) { + char buffer[40]; + qprintf(buffer, sizeof(buffer), "%s %s", Name, Models[Model].name); + if (drv_generic_text_greet(buffer, "www.bue.com")) { + sleep(3); + drv_BuE_clear(); + } + } + + /* initialize generic text driver */ + if ((ret = drv_generic_text_init(section, Name)) != 0) + return ret; + + /* initialize generic icon driver */ + if ((ret = drv_generic_text_icon_init()) != 0) + return ret; + + /* initialize generic bar driver */ + if ((ret = drv_generic_text_bar_init(0)) != 0) + return ret; + + /* add fixed chars to the bar driver */ + drv_generic_text_bar_add_segment(0, 0, 255, 32); /* ASCII 32 = blank */ + drv_generic_text_bar_add_segment(255, 255, 255, 255); /* ASCII 255 = block */ + + /* register text widget */ + wc = Widget_Text; + wc.draw = drv_generic_text_draw; + widget_register(&wc); + + /* register icon widget */ + wc = Widget_Icon; + wc.draw = drv_generic_text_icon_draw; + widget_register(&wc); + + /* register bar widget */ + wc = Widget_Bar; + wc.draw = drv_generic_text_bar_draw; + widget_register(&wc); + + /* register plugins */ + AddFunction("LCD::contrast", -1, plugin_contrast); + AddFunction("LCD::backlight", -1, plugin_backlight); + AddFunction("LCD::gpo", -1, plugin_gpo); + AddFunction("LCD::gpi", 1, plugin_gpi); + AddFunction("LCD::adc", 0, plugin_adc); + AddFunction("LCD::pwm", -1, plugin_pwm); + + return 0; } /* close driver & display */ -int drv_BuE_quit (const int quiet) { +int drv_BuE_quit(const int quiet) +{ + + info("%s: shutting down.", Name); - info("%s: shutting down.", Name); + drv_generic_text_quit(); - drv_generic_text_quit(); - - /* clear display */ - drv_BuE_clear(); + /* clear display */ + drv_BuE_clear(); - /* say goodbye... */ - if (!quiet) { - drv_generic_text_greet ("goodbye!", NULL); - } - - drv_generic_serial_close(); + /* say goodbye... */ + if (!quiet) { + drv_generic_text_greet("goodbye!", NULL); + } - return (0); + drv_generic_serial_close(); + + return (0); } DRIVER drv_BeckmannEgle = { - name: Name, - list: drv_BuE_list, - init: drv_BuE_init, - quit: drv_BuE_quit, + name:Name, + list:drv_BuE_list, + init:drv_BuE_init, + quit:drv_BuE_quit, }; - -- cgit v1.2.3