support for Sure Electronics DE-LD021 by Natanael Olaiz

git-svn-id: https://ssl.bulix.org/svn/lcd4linux/trunk@1138 3ae390bd-cb1e-0410-b409-cd5a39f66f1f

1 files changed, 8 insertions, 10 deletions

diff --git a/drv_MatrixOrbital.c b/drv_MatrixOrbital.c
index fce549b..5f6fd15 100644
--- a/drv_MatrixOrbital.c
+++ b/drv_MatrixOrbital.c
@@ -58,7 +58,7 @@ static char Name[] = "MatrixOrbital";
 static int Model;
 static int Protocol;
 
-static char dispBuffer[2][16];
+static char dispBuffer[4][20];
 
 typedef struct {
     int type;
@@ -101,6 +101,7 @@ static MODEL Models[] = {
     {0x38, "LK204-24-USB", 4, 20, 8, 8, 2},
     {0x39, "VK204-24-USB", 4, 20, 8, 8, 2},
     {0x40, "DE-LD011", 2, 16, 0, 0, 3},	/* Sure electronics USB LCD board Rev.I */
+    {0x41, "DE-LD021", 4, 20, 0, 0, 3},
     {0xff, "Unknown", -1, -1, 0, 0, 0}
 };
 
@@ -118,7 +119,7 @@ static void drv_MO_write(const int row, const int col, const char *data, const i
 	cmd[3] = (char) row + 1;
 	strncpy(&(dispBuffer[row][col]), data, len);
 	drv_generic_serial_write(cmd, 4);
-	drv_generic_serial_write(dispBuffer[row], 16);
+	drv_generic_serial_write(dispBuffer[row], Models[Model].cols);
     } else {
 	cmd[2] = (char) col + 1;
 	cmd[3] = (char) row + 1;
@@ -142,15 +143,12 @@ static void drv_MO_clear(void)
 
     case 3:
 	/* Sure electronics USB LCD board - clear buffer */
-	for (i = 0; i < 2; i++) {
-	    for (j = 0; j < 16; j++) {
+	for (i = 0; i < Models[Model].rows; i++) {
+	    for (j = 0; j < Models[Model].cols; j++) {
 		dispBuffer[i][j] = ' ';
 	    }
+	    drv_MO_write(1, i + 1, dispBuffer[i], Models[Model].cols);
 	}
-
-	drv_MO_write(1, 1, dispBuffer[0], 16);
-	drv_MO_write(1, 2, dispBuffer[1], 16);
-
 	break;
     }
 }
@@ -329,8 +327,8 @@ static int drv_MO_start(const char *section, const int quiet)
 
     if (Models[i].protocol == 3) {	// Sure electronics USB LCD board - full line output
 	int i, j;
-	for (i = 0; i < 2; i++) {	// Clear buffer
-	    for (j = 0; j < 16; j++) {
+	for (i = 0; i < Models[i].rows; i++) {	// Clear buffer
+	    for (j = 0; j < Models[i].cols; j++) {
 		dispBuffer[i][j] = ' ';
 	    }
 	}