-/* $Id: drv_MatrixOrbital.c,v 1.39 2005/05/08 04:32:44 reinelt Exp $
+/* $Id: drv_MatrixOrbital.c,v 1.40 2006/01/03 06:13:45 reinelt Exp $
*
* new style driver for Matrix Orbital serial display modules
*
*
*
* $Log: drv_MatrixOrbital.c,v $
+ * Revision 1.40 2006/01/03 06:13:45 reinelt
+ * GPIO's for MatrixOrbital
+ *
* Revision 1.39 2005/05/08 04:32:44 reinelt
* CodingStyle added and applied
*
#include <stdio.h>
#include <string.h>
#include <unistd.h>
+#include <time.h>
#include "debug.h"
#include "cfg.h"
#include "widget_bar.h"
#include "drv.h"
#include "drv_generic_text.h"
+#include "drv_generic_gpio.h"
#include "drv_generic_serial.h"
static int Model;
static int Protocol;
-/* Fixme: GPO's not yet implemented */
-/* static int GPO[8]; */
-static int GPOS;
-
-
typedef struct {
int type;
char *name;
int rows;
int cols;
+ int gpis;
int gpos;
int protocol;
} MODEL;
/* Fixme #2: protocol should be verified */
static MODEL Models[] = {
- {0x01, "LCD0821", 2, 8, 0, 1},
- {0x03, "LCD2021", 2, 20, 0, 1},
- {0x04, "LCD1641", 4, 16, 0, 1},
- {0x05, "LCD2041", 4, 20, 0, 1},
- {0x06, "LCD4021", 2, 40, 0, 1},
- {0x07, "LCD4041", 4, 40, 0, 1},
- {0x08, "LK202-25", 2, 20, 0, 2},
- {0x09, "LK204-25", 4, 20, 0, 2},
- {0x0a, "LK404-55", 4, 40, 0, 2},
- {0x0b, "VFD2021", 2, 20, 0, 1},
- {0x0c, "VFD2041", 4, 20, 0, 1},
- {0x0d, "VFD4021", 2, 40, 0, 1},
- {0x0e, "VK202-25", 2, 20, 0, 1},
- {0x0f, "VK204-25", 4, 20, 0, 1},
- {0x10, "GLC12232", -1, -1, 0, 1},
- {0x13, "GLC24064", -1, -1, 0, 1},
- {0x15, "GLK24064-25", -1, -1, 0, 1},
- {0x22, "GLK12232-25", -1, -1, 0, 1},
- {0x31, "LK404-AT", 4, 40, 0, 2},
- {0x32, "VFD1621", 2, 16, 0, 1},
- {0x33, "LK402-12", 2, 40, 0, 2},
- {0x34, "LK162-12", 2, 16, 0, 2},
- {0x35, "LK204-25PC", 4, 20, 0, 2},
- {0x36, "LK202-24-USB", 2, 20, 0, 2},
- {0x38, "LK204-24-USB", 4, 20, 0, 2},
- {0xff, "Unknown", -1, -1, 0, 0}
+ {0x01, "LCD0821", 2, 8, 0, 1, 1},
+ {0x03, "LCD2021", 2, 20, 0, 1, 1},
+ {0x04, "LCD1641", 4, 16, 0, 1, 1},
+ {0x05, "LCD2041", 4, 20, 0, 1, 1},
+ {0x06, "LCD4021", 2, 40, 0, 1, 1},
+ {0x07, "LCD4041", 4, 40, 0, 1, 1},
+ {0x08, "LK202-25", 2, 20, 8, 8, 2},
+ {0x09, "LK204-25", 4, 20, 8, 8, 2},
+ {0x0a, "LK404-55", 4, 40, 8, 8, 2},
+ {0x0b, "VFD2021", 2, 20, 0, 1, 1},
+ {0x0c, "VFD2041", 4, 20, 0, 1, 1},
+ {0x0d, "VFD4021", 2, 40, 0, 1, 1},
+ {0x0e, "VK202-25", 2, 20, 0, 1, 1},
+ {0x0f, "VK204-25", 4, 20, 0, 1, 1},
+ {0x10, "GLC12232", -1, -1, 0, 1, 1},
+ {0x13, "GLC24064", -1, -1, 0, 1, 1},
+ {0x15, "GLK24064-25", -1, -1, 0, 1, 1},
+ {0x22, "GLK12232-25", -1, -1, 0, 1, 1},
+ {0x31, "LK404-AT", 4, 40, 8, 8, 2},
+ {0x32, "VFD1621", 2, 16, 0, 1, 1},
+ {0x33, "LK402-12", 2, 40, 8, 8, 2},
+ {0x34, "LK162-12", 2, 16, 8, 8, 2},
+ {0x35, "LK204-25PC", 4, 20, 8, 8, 2},
+ {0x36, "LK202-24-USB", 2, 20, 8, 8, 2},
+ {0x38, "LK204-24-USB", 4, 20, 8, 8, 2},
+ {0x39, "VK204-24-USB", 4, 20, 8, 8, 2},
+ {0xff, "Unknown", -1, -1, 0, 0, 0}
};
}
-static int drv_MO_gpo(int num, int val)
+static int drv_MO_GPI(const int num)
{
- static int GPO[6] = { -1, -1, -1, -1, -1, -1 };
- char cmd[3] = "\376";
+ static int GPI[8] = { -1, -1, -1, -1, -1, -1, -1, -1 };
+ static time_t T[8], now;
+
+
+ if (num < 0 || num > 7) {
+ return 0;
+ }
+
+ /* read RPM every two seconds */
+ if (time(&now) - T[num] >= 2) {
+
+ char cmd[3];
+ unsigned char ans[7];
+
+ T[num] = now;
+
+ cmd[0] = '\376';
+ cmd[1] = '\301';
+ cmd[2] = (char) num+1;
+ drv_generic_serial_write(cmd, 3);
+ usleep(100000);
+
+ if (drv_generic_serial_read((char*)ans, 7) == 7) {
+ if (ans[0] == 0x23 && ans[1] == 0x2a && ans[2] == 0x03 && ans[3] == 0x52 && ans[4] == num+1) {
+ GPI[num] = 18750000 / (256*ans[5]+ans[6]);
+ } else {
+ error ("%s: strange answer %02x %02x %02x %02x %02x %02x %02x",
+ Name, ans[0], ans[1], ans[2], ans[3], ans[4], ans[5], ans[6]);
+ }
+ }
+ }
- if (num < 1)
- num = 1;
- if (num > 6)
- num = 6;
+ return GPI[num];
+}
- /* -1 is used to query the current GPO */
- if (val == -1)
- return GPO[num - 1];
- if (val < 0)
- val = 0;
- if (val > 1)
- val = 1;
- GPO[num - 1] = val;
+static int drv_MO_GPO(const int num, const int val)
+{
+ int v = 0;
+ char cmd[4];
switch (Protocol) {
case 1:
- if (num == 1) {
+ if (num == 0) {
if (val > 0) {
+ v = 1;
drv_generic_serial_write("\376W", 2); /* GPO on */
} else {
+ v = 0;
drv_generic_serial_write("\376V", 2); /* GPO off */
}
- } else {
- GPO[num - 1] = -1;
}
break;
case 2:
- if (val > 0) {
+ if (val <= 0) {
+ v = 0;
+ cmd[0] = '\376';
+ cmd[1] = 'V'; /* GPO off */
+ cmd[2] = (char) num + 1;
+ drv_generic_serial_write(cmd, 3);
+ } else if (val >= 255) {
+ v = 255;
+ cmd[0] = '\376';
cmd[1] = 'W'; /* GPO on */
+ cmd[2] = (char) num + 1;
+ drv_generic_serial_write(cmd, 3);
} else {
- cmd[1] = 'V'; /* GPO off */
+ v = val;
+ cmd[0] = '\376';
+ cmd[1] = '\300'; /* PWM control */
+ cmd[2] = (char) num + 1;
+ cmd[3] = (char) v;
+ drv_generic_serial_write(cmd, 4);
}
- cmd[2] = (char) num;
- drv_generic_serial_write(cmd, 3);
break;
}
- return GPO[num - 1];
-}
-
-
-static int drv_MO_pwm(int num, int val)
-{
- static int PWM[6] = { -1, -1, -1, -1, -1, -1 };
- char cmd[4] = "\376\300";
-
- if (num < 1)
- num = 1;
- if (num > 6)
- num = 6;
-
- /* -1 is used to query the current PWM */
- if (val == -1)
- return PWM[num - 1];
-
- if (val < 0)
- val = 0;
- if (val > 255)
- val = 255;
- PWM[num - 1] = val;
-
- cmd[2] = (char) num;
- cmd[3] = (char) val;
- drv_generic_serial_write(cmd, 4);
-
- return val;
-}
-
-
-static int drv_MO_rpm(int num)
-{
- static int RPM[6] = { -1, -1, -1, -1, -1, -1 };
- char cmd[3] = "\376\301";
- char buffer[7];
-
- if (num < 1)
- num = 1;
- if (num > 6)
- num = 6;
-
- cmd[2] = (char) num;
- drv_generic_serial_write(cmd, 3);
-
- usleep(100000);
- drv_generic_serial_read(buffer, 7);
-
- debug("rpm: buffer[0]=0x%01x", buffer[0]);
- debug("rpm: buffer[1]=0x%01x", buffer[1]);
- debug("rpm: buffer[2]=0x%01x", buffer[2]);
- debug("rpm: buffer[3]=0x%01x", buffer[3]);
- debug("rpm: buffer[4]=0x%01x", buffer[4]);
- debug("rpm: buffer[5]=0x%01x", buffer[5]);
- debug("rpm: buffer[6]=0x%01x", buffer[6]);
-
- /* Fixme: RPM calculations??? */
- RPM[num - 1] = 42;
-
- return RPM[num - 1];
+ return v;
}
/* initialize global variables */
DROWS = Models[Model].rows;
DCOLS = Models[Model].cols;
+ GPIS = Models[Model].gpis;
GPOS = Models[Model].gpos;
Protocol = Models[Model].protocol;
}
-static void plugin_gpo(RESULT * result, const int argc, RESULT * argv[])
-{
- double gpo;
-
- switch (argc) {
- case 1:
- gpo = drv_MO_gpo(R2N(argv[0]), -1);
- SetResult(&result, R_NUMBER, &gpo);
- break;
- case 2:
- gpo = drv_MO_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_pwm(RESULT * result, const int argc, RESULT * argv[])
-{
- double pwm;
-
- switch (argc) {
- case 1:
- pwm = drv_MO_pwm(R2N(argv[0]), -1);
- SetResult(&result, R_NUMBER, &pwm);
- break;
- case 2:
- pwm = drv_MO_pwm(R2N(argv[0]), R2N(argv[1]));
- SetResult(&result, R_NUMBER, &pwm);
- break;
- default:
- error("%s:pwm(): wrong number of parameters", Name);
- SetResult(&result, R_STRING, "");
- }
-}
-
-
-static void plugin_rpm(RESULT * result, RESULT * arg1)
-{
- double rpm;
-
- rpm = drv_MO_rpm(R2N(arg1));
- SetResult(&result, R_NUMBER, &rpm);
-}
-
-
/****************************************/
/*** widget callbacks ***/
/****************************************/
/* using drv_generic_text_draw(W) */
/* using drv_generic_text_icon_draw(W) */
/* using drv_generic_text_bar_draw(W) */
+/* using drv_generic_gpio_draw(W) */
/****************************************/
/* real worker functions */
drv_generic_text_real_write = drv_MO_write;
drv_generic_text_real_defchar = drv_MO_defchar;
+ drv_generic_gpio_real_get = drv_MO_GPI;
+ drv_generic_gpio_real_set = drv_MO_GPO;
/* start display */
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 */
+ /* initialize generic GPIO driver */
+ if (GPIS > 0 || GPOS > 0) {
+ if ((ret = drv_generic_gpio_init(section, Name)) != 0)
+ return ret;
+ }
+
/* register text widget */
wc = Widget_Text;
wc.draw = drv_generic_text_draw;
/* register plugins */
AddFunction("LCD::contrast", -1, plugin_contrast);
AddFunction("LCD::backlight", -1, plugin_backlight);
- AddFunction("LCD::gpo", -1, plugin_gpo);
- AddFunction("LCD::pwm", -1, plugin_pwm);
- AddFunction("LCD::rpm", 1, plugin_rpm);
-
+
return 0;
}
int drv_MO_quit(const int quiet)
{
- info("%s: shutting down.", Name);
+ info("%s: shutting down display.", Name);
drv_generic_text_quit();
+ drv_generic_gpio_clear();
+
+ if (GPIS > 0 || GPOS > 0) {
+ drv_generic_gpio_quit();
+ }
/* clear display */
drv_MO_clear();
-/* $Id: drv_generic_gpio.c,v 1.2 2005/12/20 07:07:44 reinelt Exp $
+/* $Id: drv_generic_gpio.c,v 1.3 2006/01/03 06:13:45 reinelt Exp $
*
* generic driver helper for GPO's
*
*
*
* $Log: drv_generic_gpio.c,v $
+ * Revision 1.3 2006/01/03 06:13:45 reinelt
+ * GPIO's for MatrixOrbital
+ *
* Revision 1.2 2005/12/20 07:07:44 reinelt
* further work on GPO's, HD44780 GPO support
*
*
* exported fuctions:
*
- * int drv_generic_gpio_init(const char *section, const char *driver);
+ * 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);
+ * 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);
+ * int drv_generic_gpio_quit(void)
* closes the generic GPIO driver
*
*/
#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[])
{
SetResult(&result, R_STRING, "");
return;
}
- gpo = GPO[num-1];
+ gpo = GPO[num - 1];
SetResult(&result, R_NUMBER, &gpo);
break;
case 2:
SetResult(&result, R_STRING, "");
return;
}
- if (GPO[num-1] != val) {
- GPO[num-1] = drv_generic_gpio_real_set(num-1, val);
+ 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];
+ gpo = GPO[num - 1];
SetResult(&result, R_NUMBER, &gpo);
break;
default:
Section = (char *) section;
Driver = (char *) driver;
- if (GPIS <= 0 && GPOS <= 0) {
- error("%s: Huh? gpio_init(GPIS=%d, GPOS=%d)", Driver, GPIS, GPOS);
- }
+ info("%s: using %d GPI's and %d GPO's", Driver, GPIS, GPOS);
/* reset all GPO's */
drv_generic_gpio_clear();
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 i;
- /* init GPO bufferr */
+ /* 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++) {
- GPO[i] = drv_generic_gpio_real_set(i, 0);
+ 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;
}
if (GPO[num] != val) {
- GPO[num] = drv_generic_gpio_real_set(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);
return 0;
}
-/* $Id: drv_generic_text.c,v 1.29 2005/11/06 09:54:43 reinelt Exp $
+/* $Id: drv_generic_text.c,v 1.30 2006/01/03 06:13:46 reinelt Exp $
*
* generic driver helper for text-based displays
*
*
*
* $Log: drv_generic_text.c,v $
+ * Revision 1.30 2006/01/03 06:13:46 reinelt
+ * GPIO's for MatrixOrbital
+ *
* Revision 1.29 2005/11/06 09:54:43 reinelt
* fixed icon size removed, uses XRES & YRES (I hope this doesn't lead to problemes...)
*
int INVALIDATE = 0; /* re-send a modified userdefined char? */
+void (*drv_generic_text_real_write) () = NULL;
+void (*drv_generic_text_real_defchar) () = NULL;
+
static char *LayoutFB = NULL;
static char *DisplayFB = NULL;
for (i = 0; line1[i]; i++) {
if (strlen(line1[i]) <= (unsigned) DCOLS) {
- drv_generic_text_real_write(0, (DCOLS - strlen(line1[i])) / 2, line1[i], strlen(line1[i]));
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(0, (DCOLS - strlen(line1[i])) / 2, line1[i], strlen(line1[i]));
flag = 1;
break;
}
if (DROWS >= 2) {
for (i = 0; line2[i]; i++) {
if (strlen(line2[i]) <= (unsigned) DCOLS) {
- drv_generic_text_real_write(1, (DCOLS - strlen(line2[i])) / 2, line2[i], strlen(line2[i]));
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(1, (DCOLS - strlen(line2[i])) / 2, line2[i], strlen(line2[i]));
flag = 1;
break;
}
if (msg1 && DROWS >= 3) {
int len = strlen(msg1);
if (len <= DCOLS) {
- drv_generic_text_real_write(2, (DCOLS - len) / 2, msg1, len);
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(2, (DCOLS - len) / 2, msg1, len);
flag = 1;
}
}
if (msg2 && DROWS >= 4) {
int len = strlen(msg2);
if (len <= DCOLS) {
- drv_generic_text_real_write(3, (DCOLS - len) / 2, msg2, len);
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(3, (DCOLS - len) / 2, msg2, len);
flag = 1;
}
}
}
}
memcpy(fb2 + pos1, fb1 + pos1, pos2 - pos1 + 1);
- drv_generic_text_real_write(row, col0, fb2 + pos1, pos2 - pos1 + 1);
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(row, col0, fb2 + pos1, pos2 - pos1 + 1);
}
}
/* maybe redefine icon */
if (Icon->curmap != Icon->prvmap && Icon->visible) {
Icon->prvmap = Icon->curmap;
- drv_generic_text_real_defchar(Icon->ascii, Icon->bitmap + YRES * Icon->curmap);
+ if (drv_generic_text_real_defchar)
+ drv_generic_text_real_defchar(Icon->ascii, Icon->bitmap + YRES * Icon->curmap);
invalidate = INVALIDATE;
}
/* maybe send icon to the display */
if (row < DROWS && col < DCOLS && (DisplayFB[d_idx] != ascii || invalidate)) {
DisplayFB[d_idx] = ascii;
- drv_generic_text_real_write(row, col, DisplayFB + d_idx, 1);
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(row, col, DisplayFB + d_idx, 1);
}
return 0;
break;
/* hollow style, val(1,2) == 1, like '[' */
/* if (l1 == 1 && l2 == 1 && Segment[i].style == STYLE_FIRST && BarFB[n].style == STYLE_HOLLOW)
- break;
+ break;
*//* hollow style, val(1,2) == 1, like ']' */
/* if (l1 == 1 && l2 == 1 && Segment[i].style == STYLE_LAST && BarFB[n].style == STYLE_HOLLOW)
break;
}
break;
}
- drv_generic_text_real_defchar(CHAR0 + c, buffer);
+ if (drv_generic_text_real_defchar)
+ drv_generic_text_real_defchar(CHAR0 + c, buffer);
/* maybe invalidate framebuffer */
if (INVALIDATE) {
}
}
memcpy(DisplayFB + row * DCOLS + pos1, LayoutFB + row * LCOLS + pos1, pos2 - pos1 + 1);
- drv_generic_text_real_write(row, col0, DisplayFB + row * DCOLS + pos1, pos2 - pos1 + 1);
+ if (drv_generic_text_real_write)
+ drv_generic_text_real_write(row, col0, DisplayFB + row * DCOLS + pos1, pos2 - pos1 + 1);
}
}
projects / lcd4linux.git / commitdiff