parent
46320ef4b9
commit
def04042a7
@ -0,0 +1,256 @@ |
|||||||
|
/**
|
||||||
|
* ANSI code parser callbacks that do the actual work. |
||||||
|
* Split from the parser itself for easier editing without |
||||||
|
* having to deal with Ragel. |
||||||
|
*/ |
||||||
|
|
||||||
|
#include <esp8266.h> |
||||||
|
#include "ansi_parser_callbacks.h" |
||||||
|
#include "screen.h" |
||||||
|
#include "ansi_parser.h" |
||||||
|
#include "uart_driver.h" |
||||||
|
|
||||||
|
/**
|
||||||
|
* Handle a received plain character |
||||||
|
*/ |
||||||
|
void ICACHE_FLASH_ATTR |
||||||
|
apars_handle_plainchar(char c) |
||||||
|
{ |
||||||
|
screen_putchar(c); |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* Bad sequence received, show warning |
||||||
|
*/ |
||||||
|
void apars_handle_badseq(void) |
||||||
|
{ |
||||||
|
warn("Invalid escape sequence discarded."); |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Handle fully received CSI ANSI sequence |
||||||
|
* \param leadchar - private range leading character, 0 if none |
||||||
|
* \param params - array of CSI_N_MAX ints holding the numeric arguments |
||||||
|
* \param keychar - the char terminating the sequence |
||||||
|
*/ |
||||||
|
void ICACHE_FLASH_ATTR |
||||||
|
apars_handle_CSI(char leadchar, int *params, char keychar) |
||||||
|
{ |
||||||
|
/*
|
||||||
|
Implemented codes (from Wikipedia) |
||||||
|
|
||||||
|
CSI n A CUU – Cursor Up |
||||||
|
CSI n B CUD – Cursor Down |
||||||
|
CSI n C CUF – Cursor Forward |
||||||
|
CSI n D CUB – Cursor Back |
||||||
|
CSI n E CNL – Cursor Next Line |
||||||
|
CSI n F CPL – Cursor Previous Line |
||||||
|
CSI n G CHA – Cursor Horizontal Absolute |
||||||
|
CSI n ; m H CUP – Cursor Position |
||||||
|
CSI n J ED – Erase Display |
||||||
|
CSI n K EL – Erase in Line |
||||||
|
CSI n S SU – Scroll Up |
||||||
|
CSI n T SD – Scroll Down |
||||||
|
CSI n ; m f HVP – Horizontal and Vertical Position |
||||||
|
CSI n m SGR – Select Graphic Rendition (Implemented only some) |
||||||
|
CSI 6n DSR – Device Status Report NOT IMPL |
||||||
|
CSI s SCP – Save Cursor Position |
||||||
|
CSI u RCP – Restore Cursor Position |
||||||
|
CSI ?25l DECTCEM Hides the cursor |
||||||
|
CSI ?25h DECTCEM Shows the cursor |
||||||
|
*/ |
||||||
|
|
||||||
|
int n1 = params[0]; |
||||||
|
int n2 = params[1]; |
||||||
|
// int n3 = params[2];
|
||||||
|
|
||||||
|
// defaults
|
||||||
|
switch (keychar) { |
||||||
|
case 'A': |
||||||
|
case 'B': |
||||||
|
case 'C': |
||||||
|
case 'D': |
||||||
|
case 'E': |
||||||
|
case 'F': |
||||||
|
case 'G': |
||||||
|
case 'S': |
||||||
|
case 'T': |
||||||
|
if (n1 == 0) n1 = 1; |
||||||
|
break; |
||||||
|
|
||||||
|
case 'H': |
||||||
|
case 'f': |
||||||
|
if (n1 == 0) n1 = 1; |
||||||
|
if (n2 == 0) n2 = 1; |
||||||
|
break; |
||||||
|
|
||||||
|
case 'J': |
||||||
|
case 'K': |
||||||
|
if (n1 > 2) n1 = 0; |
||||||
|
break; |
||||||
|
} |
||||||
|
|
||||||
|
switch (keychar) { |
||||||
|
// CUU CUD CUF CUB
|
||||||
|
case 'A': screen_cursor_move(0, -n1); break; |
||||||
|
case 'B': screen_cursor_move(0, n1); break; |
||||||
|
case 'C': screen_cursor_move(n1, 0); break; |
||||||
|
case 'D': screen_cursor_move(-n1, 0); break; |
||||||
|
|
||||||
|
case 'E': // CNL
|
||||||
|
screen_cursor_move(0, n1); |
||||||
|
screen_cursor_set_x(0); |
||||||
|
break; |
||||||
|
|
||||||
|
case 'F': // CPL
|
||||||
|
screen_cursor_move(0, -n1); |
||||||
|
screen_cursor_set_x(0); |
||||||
|
break; |
||||||
|
|
||||||
|
// CHA
|
||||||
|
case 'G': |
||||||
|
screen_cursor_set_x(n1 - 1); break; // 1-based
|
||||||
|
|
||||||
|
// SU, SD
|
||||||
|
case 'S': screen_scroll_up(n1); break; |
||||||
|
case 'T': screen_scroll_down(n1); break; |
||||||
|
|
||||||
|
// CUP,HVP
|
||||||
|
case 'H': |
||||||
|
case 'f': |
||||||
|
screen_cursor_set(n2-1, n1-1); break; // 1-based
|
||||||
|
|
||||||
|
case 'J': // ED
|
||||||
|
if (n1 == 0) { |
||||||
|
screen_clear(CLEAR_TO_CURSOR); |
||||||
|
} else if (n1 == 1) { |
||||||
|
screen_clear(CLEAR_FROM_CURSOR); |
||||||
|
} else { |
||||||
|
screen_clear(CLEAR_ALL); |
||||||
|
screen_cursor_set(0, 0); |
||||||
|
} |
||||||
|
break; |
||||||
|
|
||||||
|
case 'K': // EL
|
||||||
|
if (n1 == 0) { |
||||||
|
screen_clear_line(CLEAR_TO_CURSOR); |
||||||
|
} else if (n1 == 1) { |
||||||
|
screen_clear_line(CLEAR_FROM_CURSOR); |
||||||
|
} else { |
||||||
|
screen_clear_line(CLEAR_ALL); |
||||||
|
screen_cursor_set_x(0); |
||||||
|
} |
||||||
|
break; |
||||||
|
|
||||||
|
// SCP, RCP
|
||||||
|
case 's': screen_cursor_save(); break; |
||||||
|
case 'u': screen_cursor_restore(); break; |
||||||
|
|
||||||
|
// DECTCEM cursor show hide
|
||||||
|
case 'l': |
||||||
|
if (leadchar == '?' && n1 == 25) { |
||||||
|
screen_cursor_enable(1); |
||||||
|
} |
||||||
|
break; |
||||||
|
|
||||||
|
case 'h': |
||||||
|
if (leadchar == '?' && n1 == 25) { |
||||||
|
screen_cursor_enable(0); |
||||||
|
} |
||||||
|
break; |
||||||
|
|
||||||
|
case 'm': // SGR
|
||||||
|
// iterate arguments
|
||||||
|
for (int i = 0; i < CSI_N_MAX; i++) { |
||||||
|
int n = params[i]; |
||||||
|
|
||||||
|
if (i == 0 && n == 0) { // reset SGR
|
||||||
|
screen_set_fg(7); |
||||||
|
screen_set_bg(0); |
||||||
|
break; // cannot combine reset with others
|
||||||
|
} |
||||||
|
else if (n >= 30 && n <= 37) screen_set_fg(n-30); // ANSI normal fg
|
||||||
|
else if (n >= 40 && n <= 47) screen_set_bg(n-40); // ANSI normal bg
|
||||||
|
else if (n == 39) screen_set_fg(7); // default fg
|
||||||
|
else if (n == 49) screen_set_bg(0); // default bg
|
||||||
|
else if (n == 7) screen_inverse(1); // inverse
|
||||||
|
else if (n == 27) screen_inverse(0); // positive
|
||||||
|
else if (n == 1) screen_set_bright_fg(); // ANSI bold = bright fg
|
||||||
|
else if (n >= 90 && n <= 97) screen_set_fg(n-90+8); // AIX bright fg
|
||||||
|
else if (n >= 100 && n <= 107) screen_set_bg(n-100+8); // AIX bright bg
|
||||||
|
} |
||||||
|
break; |
||||||
|
} |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* \brief Handle a request to reset the display device |
||||||
|
*/ |
||||||
|
void ICACHE_FLASH_ATTR |
||||||
|
apars_handle_RESET_cmd(void) |
||||||
|
{ |
||||||
|
// XXX maybe user wanted to reset the module instead?
|
||||||
|
screen_reset(); |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* Handle a factory reset request |
||||||
|
*/ |
||||||
|
void ICACHE_FLASH_ATTR |
||||||
|
apars_handle_OSC_FactoryReset(void) |
||||||
|
{ |
||||||
|
info("OSC: Factory reset"); |
||||||
|
|
||||||
|
// Send acknowledgement message to UART0
|
||||||
|
// User is performing this manually, so we can just print it as string
|
||||||
|
UART_WriteString(UART0, "\r\nFACTORY RESET\r\n", UART_TIMEOUT_US); |
||||||
|
|
||||||
|
// Disconnect from AP if connected
|
||||||
|
int opmode = wifi_get_opmode(); |
||||||
|
if (opmode != SOFTAP_MODE) { |
||||||
|
wifi_station_disconnect(); |
||||||
|
} |
||||||
|
|
||||||
|
// Both must be enabled so we can manipulate their settings
|
||||||
|
wifi_set_opmode(STATIONAP_MODE); |
||||||
|
|
||||||
|
// --- AP config ---
|
||||||
|
struct softap_config apconf; |
||||||
|
wifi_softap_get_config(&apconf); |
||||||
|
apconf.authmode=AUTH_OPEN; // Disable access protection
|
||||||
|
apconf.channel=1; // Reset channel; user may have set bad channel in the UI
|
||||||
|
|
||||||
|
// generate unique AP name
|
||||||
|
u8 mac[6]; |
||||||
|
wifi_get_macaddr(SOFTAP_IF, mac); |
||||||
|
sprintf((char*)apconf.ssid, "TERM-%02X%02X%02X", mac[3], mac[4], mac[5]); |
||||||
|
apconf.ssid_len = (u8)strlen((char*)apconf.ssid); |
||||||
|
|
||||||
|
// --- Station ---
|
||||||
|
struct station_config staconf; |
||||||
|
wifi_station_get_config(&staconf); |
||||||
|
|
||||||
|
// clear info about SSID
|
||||||
|
staconf.ssid[0]=0; |
||||||
|
staconf.bssid_set=0; |
||||||
|
staconf.password[0]=0; |
||||||
|
|
||||||
|
wifi_softap_set_config(&apconf); |
||||||
|
wifi_station_set_config(&staconf); |
||||||
|
|
||||||
|
UART_WriteString(UART0, "Factory Reset complete, device reset.\r\n\r\n", UART_TIMEOUT_US); |
||||||
|
|
||||||
|
// Reboot to clean STA+AP mode with Channel 1 & reset AP SSID.
|
||||||
|
system_restart(); |
||||||
|
} |
||||||
|
|
||||||
|
/**
|
||||||
|
* Handle a screen resize request |
||||||
|
*/ |
||||||
|
void ICACHE_FLASH_ATTR |
||||||
|
apars_handle_OSC_SetScreenSize(int rows, int cols) |
||||||
|
{ |
||||||
|
info("OSC: Set screen size to %d x %d", rows, cols); |
||||||
|
|
||||||
|
screen_resize(rows, cols); |
||||||
|
} |
||||||
@ -0,0 +1,11 @@ |
|||||||
|
#ifndef ANSI_PARSER_CALLBACKS_H |
||||||
|
#define ANSI_PARSER_CALLBACKS_H |
||||||
|
|
||||||
|
void apars_handle_badseq(void); |
||||||
|
void apars_handle_CSI(char leadchar, int *params, char keychar); |
||||||
|
void apars_handle_RESET_cmd(void); |
||||||
|
void apars_handle_plainchar(char c); |
||||||
|
void apars_handle_OSC_FactoryReset(void); |
||||||
|
void apars_handle_OSC_SetScreenSize(int rows, int cols); |
||||||
|
|
||||||
|
#endif //ESP_VT100_FIRMWARE_ANSI_PARSER_CALLBACKS_H
|
||||||
Loading…
Reference in new issue