static int drv_PICGraphic_recv(char *dest, const unsigned int len, const char *expect)
{
unsigned int bytes = 0;
int status;
while (bytes < len) {
status = drv_generic_serial_read((char *) dest + bytes, 1);
if (status == 1) {
if (dest[bytes] != 0xa && dest[bytes] != 0xd) {
if (dest[bytes] != '@') {
bytes += status;
}
}
} else {
info("error receiving response: %d", status);
return status;
}
usleep(10000);
}
status = strncmp((const char *) dest, expect, len);
if (!status) {
return 0;
} else {
return 1;
}
}
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];
}
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];
}
static int drv_MO_GPI(const int num)
{
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]);
}
}
}
return GPI[num];
}
static int drv_MO_start(const char *section, const int quiet)
{
int i;
char *model;
char buffer[256];
model = cfg_get(section, "Model", NULL);
if (model != NULL && *model != '\0') {
for (i = 0; Models[i].type != 0xff; i++) {
if (strcasecmp(Models[i].name, model) == 0)
break;
}
if (Models[i].type == 0xff) {
error("%s: %s.Model '%s' is unknown from %s", Name, section, model, cfg_source());
return -1;
}
Model = i;
info("%s: using model '%s'", Name, Models[Model].name);
} else {
info("%s: no '%s.Model' entry from %s, auto-dedecting", Name, section, cfg_source());
Model = -1;
}
if (Model != -1 && Models[Model].protocol == 3) { // Sure electronics USB LCD board - full line output
int i, j;
for (i = 0; i < Models[Model].rows; i++) { // Clear buffer
for (j = 0; j < Models[Model].cols; j++) {
dispBuffer[i][j] = ' ';
}
}
}
if (drv_generic_serial_open(section, Name, 0) < 0)
return -1;
if (Model == -1 || Models[Model].protocol > 1) {
/* read module type */
drv_generic_serial_write("\3767", 2);
usleep(1000);
if (drv_generic_serial_read(buffer, 1) == 1) {
for (i = 0; Models[i].type != 0xff; i++) {
if (Models[i].type == (int) *buffer)
break;
}
info("%s: display reports model '%s' (type 0x%02x)", Name, Models[i].name, Models[i].type);
/* auto-dedection */
if (Model == -1)
Model = i;
/* auto-dedection matches specified model? */
if (Models[i].type != 0xff && Model != i) {
error("%s: %s.Model '%s' from %s does not match dedected Model '%s'", Name, section, model,
cfg_source(), Models[i].name);
return -1;
}
} else {
info("%s: display detection failed.", Name);
}
}
/* initialize global variables */
DROWS = Models[Model].rows;
DCOLS = Models[Model].cols;
GPIS = Models[Model].gpis;
GPOS = Models[Model].gpos;
Protocol = Models[Model].protocol;
if (Protocol > 1) {
/* read serial number */
drv_generic_serial_write("\3765", 2);
usleep(100000);
if (drv_generic_serial_read(buffer, 2) == 2) {
info("%s: display reports serial number 0x%x", Name, *(short *) buffer);
}
/* read version number */
drv_generic_serial_write("\3766", 2);
usleep(100000);
if (drv_generic_serial_read(buffer, 1) == 1) {
info("%s: display reports firmware version 0x%x", Name, *buffer);
}
}
drv_MO_clear();
drv_generic_serial_write("\376B", 3); /* backlight on */
drv_generic_serial_write("\376K", 2); /* cursor off */
drv_generic_serial_write("\376T", 2); /* blink off */
drv_generic_serial_write("\376D", 2); /* line wrapping off */
drv_generic_serial_write("\376R", 2); /* auto scroll off */
/* set contrast */
if (cfg_number(section, "Contrast", 0, 0, 255, &i) > 0) {
drv_MO_contrast(i);
}
/* set backlight */
if (cfg_number(section, "Backlight", 0, 0, 255, &i) > 0) {
drv_MO_backlight(i);
}
if (!quiet) {
if (drv_generic_text_greet(Models[Model].name, "MatrixOrbital")) {
sleep(3);
drv_MO_clear();
}
}
return 0;
}
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;
#if 0
/* 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, -1 * (int) 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;
}
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";
} 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 %d unknown type %d", Name, i, cmd[3]);
}
} else {
error("%s: error fetching type of port %d", Name, i);
}
}
return 0;
}
