diff --git a/cmd_parser.c b/cmd_parser.c index 729ed1a..1d629ef 100644 --- a/cmd_parser.c +++ b/cmd_parser.c @@ -331,6 +331,8 @@ void parse_vlan(void) vlan_settings.vlan = 0; vlan_settings.members = 0; vlan_settings.tagged = 0; + if (cmd_words_len < 2) + goto err; if (!atoi_short(&vlan_settings.vlan, cmd_words_b[1])) { if (cmd_words_len == 3 && cmd_buffer[cmd_words_b[2]] == 'd') { vlan_delete(vlan_settings.vlan); @@ -347,10 +349,11 @@ void parse_vlan(void) uint8_t w = 2; if (cmd_words_len > w && isletter(cmd_buffer[cmd_words_b[w]])) { register uint8_t i = 0; + vlan_name_remove(vlan_settings.vlan); vlan_names[vlan_ptr++] = hex[(vlan_settings.vlan >> 8) & 0xf]; vlan_names[vlan_ptr++] = hex[(vlan_settings.vlan >> 4) & 0xf] ; vlan_names[vlan_ptr++] = hex[vlan_settings.vlan & 0xf]; - while(cmd_buffer[cmd_words_b[w] + i] != ' ') { + while(cmd_buffer[cmd_words_b[w] + i] != ' ' && cmd_buffer[cmd_words_b[w] + i] != '\0') { write_char(cmd_buffer[cmd_words_b[w] + i]); vlan_names[vlan_ptr++] = cmd_buffer[cmd_words_b[w] + i++]; } diff --git a/rtl837x_port.c b/rtl837x_port.c index 7c48f90..c540ac3 100644 --- a/rtl837x_port.c +++ b/rtl837x_port.c @@ -116,11 +116,45 @@ uint16_t port_pvid_get(uint8_t port) __banked void vlan_delete(uint16_t vlan) __banked { print_string("\nvlan_delete called \n"); print_short(vlan); + vlan_name_remove(vlan); REG_WRITE(RTL837x_TBL_DATA_IN_A, 0, 0, 0, 0); REG_WRITE(RTL837X_TBL_CTRL, vlan >> 8, vlan, TBL_VLAN, TBL_WRITE | TBL_EXECUTE); } +void vlan_name_remove(uint16_t vlan) __banked +{ + static __xdata uint16_t name_pos; + static __xdata uint16_t entry_start; + static __xdata uint16_t pos; + static __xdata uint16_t entry_len; + static __xdata uint16_t move_count; + static __xdata uint16_t j; + + name_pos = vlan_name(vlan); + if (name_pos == 0xffff) + return; + + entry_start = name_pos - 3; + pos = entry_start; + + while (pos < vlan_ptr && vlan_names[pos] != ' ') + pos++; + if (pos >= vlan_ptr) + return; + pos++; + + entry_len = pos - entry_start; + move_count = vlan_ptr - pos; + + for (j = 0; j < move_count; j++) + vlan_names[entry_start + j] = vlan_names[pos + j]; + + vlan_ptr -= entry_len; + vlan_names[vlan_ptr] = 0; +} + + /* * Reads VLAN information from VLAN table * Returns data in sfr_data diff --git a/rtl837x_port.h b/rtl837x_port.h index ff036b9..a5ce278 100644 --- a/rtl837x_port.h +++ b/rtl837x_port.h @@ -50,6 +50,7 @@ void port_l2_learned(void) __banked; void port_stats_print(void) __banked; int8_t vlan_get(register uint16_t vlan) __banked; __xdata uint16_t vlan_name(register uint16_t vlan) __banked; +void vlan_name_remove(uint16_t vlan) __banked; void vlan_setup(void) __banked; void port_pvid_set(uint8_t port, __xdata uint16_t pvid) __banked; uint16_t port_pvid_get(uint8_t port) __banked;