diff options
| -rw-r--r-- | drv_MatrixOrbital.c | 38 |
1 files changed, 19 insertions, 19 deletions
diff --git a/drv_MatrixOrbital.c b/drv_MatrixOrbital.c index 4cfb88c..fce549b 100644 --- a/drv_MatrixOrbital.c +++ b/drv_MatrixOrbital.c @@ -109,6 +109,25 @@ static MODEL Models[] = { /*** hardware dependant functions ***/ /****************************************/ +static void drv_MO_write(const int row, const int col, const char *data, const int len) +{ + char cmd[5] = "\376Gyx"; + + if (Models[Model].protocol == 3) { // Sure electronics USB LCD board - full line output + cmd[2] = (char) 1; + cmd[3] = (char) row + 1; + strncpy(&(dispBuffer[row][col]), data, len); + drv_generic_serial_write(cmd, 4); + drv_generic_serial_write(dispBuffer[row], 16); + } else { + cmd[2] = (char) col + 1; + cmd[3] = (char) row + 1; + drv_generic_serial_write(cmd, 4); + drv_generic_serial_write(data, len); + } +} + + static void drv_MO_clear(void) { int i, j; @@ -137,25 +156,6 @@ static void drv_MO_clear(void) } -static void drv_MO_write(const int row, const int col, const char *data, const int len) -{ - char cmd[5] = "\376Gyx"; - - if (Models[Model].protocol == 3) { // Sure electronics USB LCD board - full line output - cmd[2] = (char) 1; - cmd[3] = (char) row + 1; - strncpy(&(dispBuffer[row][col]), data, len); - drv_generic_serial_write(cmd, 4); - drv_generic_serial_write(dispBuffer[row], 16); - } else { - cmd[2] = (char) col + 1; - cmd[3] = (char) row + 1; - drv_generic_serial_write(cmd, 4); - drv_generic_serial_write(data, len); - } -} - - static void drv_MO_defchar(const int ascii, const unsigned char *matrix) { int i; |