mirror of
https://github.com/logicog/RTLPlayground.git
synced 2026-08-30 14:52:51 +08:00
rebase First try to make use of uIP for sending syslog
This commit is contained in:
@@ -6,32 +6,59 @@
|
||||
#pragma codeseg BANK2
|
||||
#pragma constseg BANK2
|
||||
|
||||
#define SYSLOG_O ((__xdata uint8_t *)&uip_buf[RTL_TAG_SIZE + VLAN_TAG_SIZE])
|
||||
#define SYSLOG_P ((__xdata uint8_t *)uip_appdata)
|
||||
|
||||
__xdata char logbuf[LOGBUF_SIZE];
|
||||
__xdata uint16_t logptr_w = 0;
|
||||
__xdata uint16_t logptr_r = 0;
|
||||
__xdata uint8_t full_line_available = 0;
|
||||
__xdata uint8_t syslog_enabled = 0;
|
||||
__xdata uint16_t logptr_w ;
|
||||
__xdata uint16_t logptr_r;
|
||||
__xdata uint8_t full_line_available;
|
||||
__xdata uint8_t syslog_enabled;
|
||||
__xdata uip_ipaddr_t syslog_addr;
|
||||
|
||||
#define DEST_OFFSET (0)
|
||||
#define SOURCE_OFFSET (DEST_OFFSET + 6)
|
||||
#define ETHERTYPE_OFFSET (SOURCE_OFFSET + 6)
|
||||
#define IP_HEADER_OFFSET (ETHERTYPE_OFFSET + 2)
|
||||
#define UDP_HEADER_OFFSET (IP_HEADER_OFFSET + 20)
|
||||
#define UDP_PAYLOAD_OFFSET (UDP_HEADER_OFFSET + 8)
|
||||
struct uip_udp_conn *syslog_conn;
|
||||
|
||||
void syslog_init(void) __banked
|
||||
{
|
||||
syslog_enabled = 0;
|
||||
syslog_conn = 0;
|
||||
logptr_w = 0;
|
||||
logptr_r = 0;
|
||||
full_line_available = 0;
|
||||
syslog_addr[0] = 0xffff; syslog_addr[1] = 0xffff; // Default to broadcast
|
||||
syslog_addr[0] = 0; syslog_addr[1] = 0; // Default to 0.0.0.0
|
||||
}
|
||||
|
||||
void handle_syslog(void) __banked
|
||||
void syslog_start(void) __banked
|
||||
{
|
||||
if (syslog_conn == 0) {
|
||||
syslog_conn = uip_udp_new(&syslog_addr, HTONS(514));
|
||||
if (syslog_conn == 0) {
|
||||
print_string("Failed to create a new UDP client\n");
|
||||
return;
|
||||
}
|
||||
print_string("Started syslog to IP ");
|
||||
itoa(syslog_addr[0]); write_char('.'); itoa(syslog_addr[0]>>8); write_char('.');
|
||||
itoa(syslog_addr[1]); write_char('.'); itoa(syslog_addr[1]>>8); write_char('\n');
|
||||
|
||||
syslog_enabled = 1;
|
||||
}
|
||||
else {
|
||||
print_string("Syslog is already running\n");
|
||||
}
|
||||
}
|
||||
|
||||
void syslog_stop(void) __banked
|
||||
{
|
||||
syslog_enabled = 0;
|
||||
if (syslog_conn != 0) {
|
||||
uip_udp_remove(syslog_conn);
|
||||
syslog_conn = 0;
|
||||
print_string("Stopped syslog\n");
|
||||
} else {
|
||||
print_string("Syslog is not running\n");
|
||||
}
|
||||
}
|
||||
|
||||
void syslog_callback(void) __banked
|
||||
{
|
||||
if ((logptr_r != logptr_w) && full_line_available)
|
||||
{
|
||||
@@ -39,51 +66,40 @@ void handle_syslog(void) __banked
|
||||
if (log_size < 0)
|
||||
log_size += LOGBUF_SIZE;
|
||||
|
||||
if (log_size <= 4) {
|
||||
// Only some newline; not worth sending to syslog, skip it
|
||||
// Skipping linefeeds at the start of the log line
|
||||
uint16_t log_start = logptr_r;
|
||||
while (log_size > 0 && logbuf[log_start] == '\n') {
|
||||
log_start = (log_start + 1) & (LOGBUF_SIZE - 1);
|
||||
log_size--;
|
||||
}
|
||||
|
||||
// Skipping linefeeds and whitespaces at the end of the log line
|
||||
uint16_t log_end = logptr_w;
|
||||
while ( (log_size > 0) &&
|
||||
((logbuf[(log_end-1) & (LOGBUF_SIZE - 1)] == '\n') ||
|
||||
(logbuf[(log_end-1) & (LOGBUF_SIZE - 1)] == ' ')))
|
||||
{
|
||||
log_end = (log_end - 1) & (LOGBUF_SIZE - 1);
|
||||
log_size--;
|
||||
}
|
||||
|
||||
if (log_size == 0) {
|
||||
logptr_r = logptr_w;
|
||||
full_line_available = 0;
|
||||
return;
|
||||
}
|
||||
|
||||
SYSLOG_O[DEST_OFFSET] = 255; SYSLOG_O[DEST_OFFSET + 1] = 255; SYSLOG_O[DEST_OFFSET + 2] = 255;
|
||||
SYSLOG_O[DEST_OFFSET + 3] = 255; SYSLOG_O[DEST_OFFSET + 4] = 255; SYSLOG_O[DEST_OFFSET + 5] = 255; // broadcast
|
||||
memcpy(SYSLOG_O + SOURCE_OFFSET, uip_ethaddr.addr, 6); // Source MAC address
|
||||
memcpyc(SYSLOG_P, "<14>", 4); // Syslog priority prefix
|
||||
|
||||
SYSLOG_O[ETHERTYPE_OFFSET] = 0x08; SYSLOG_O[ETHERTYPE_OFFSET + 1] = 0x00; // Ethertype: IPv4
|
||||
|
||||
SYSLOG_O[IP_HEADER_OFFSET ] = 0x45; SYSLOG_O[IP_HEADER_OFFSET + 1] = 0x00; // IPv4, no options
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 2] = (20+8+4+log_size) >> 8; SYSLOG_O[IP_HEADER_OFFSET + 3] = (20+8+4+log_size) & 0xff; // Total Length (IP header + UDP header + payload)
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 4] = 0x00; SYSLOG_O[IP_HEADER_OFFSET + 5] = 0x00; // Identification
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 6] = 0x00; SYSLOG_O[IP_HEADER_OFFSET + 7] = 0x00; // Flags, Fragment Offset
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 8] = 0x40; SYSLOG_O[IP_HEADER_OFFSET + 9] = 0x11; // TTL, Protocol (UDP)
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 10] = 0x00; SYSLOG_O[IP_HEADER_OFFSET + 11] = 0x00; // Header Checksum (not calculated)
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 12] = uip_hostaddr[0] & 0xff; SYSLOG_O[IP_HEADER_OFFSET + 13] = uip_hostaddr[0] >> 8;
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 14] = uip_hostaddr[1] & 0xff; SYSLOG_O[IP_HEADER_OFFSET + 15] = uip_hostaddr[1] >> 8; // Source IP
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 16] = syslog_addr[0] & 0xff; SYSLOG_O[IP_HEADER_OFFSET + 17] = syslog_addr[0] >> 8;
|
||||
SYSLOG_O[IP_HEADER_OFFSET + 18] = syslog_addr[1] & 0xff; SYSLOG_O[IP_HEADER_OFFSET + 19] = syslog_addr[1] >> 8; // Destination IP
|
||||
|
||||
SYSLOG_O[UDP_HEADER_OFFSET ] = 0x02; SYSLOG_O[UDP_HEADER_OFFSET + 1] = 0x02; // Source Port
|
||||
SYSLOG_O[UDP_HEADER_OFFSET + 2] = 0x02; SYSLOG_O[UDP_HEADER_OFFSET + 3] = 0x02; // Destination Port
|
||||
SYSLOG_O[UDP_HEADER_OFFSET + 4] = (8+4+log_size) >> 8; SYSLOG_O[UDP_HEADER_OFFSET + 5] = (8+4+log_size) & 0xff; // Length (UDP header + payload)
|
||||
SYSLOG_O[UDP_HEADER_OFFSET + 6] = 0x00; SYSLOG_O[UDP_HEADER_OFFSET + 7] = 0x00; // Header Checksum (not calculated)
|
||||
|
||||
memcpyc(SYSLOG_O + UDP_PAYLOAD_OFFSET, "<14>", 4); // Syslog priority prefix
|
||||
|
||||
if (logptr_w < logptr_r) {
|
||||
memcpy(SYSLOG_O + UDP_PAYLOAD_OFFSET + 4, logbuf + logptr_r, LOGBUF_SIZE - logptr_r);
|
||||
memcpy(SYSLOG_O + UDP_PAYLOAD_OFFSET + 4 + LOGBUF_SIZE - logptr_r, logbuf, logptr_w);
|
||||
if (log_end < log_start) {
|
||||
memcpy(SYSLOG_P + 4, logbuf + log_start, LOGBUF_SIZE - log_start);
|
||||
memcpy(SYSLOG_P + 4 + LOGBUF_SIZE - log_start, logbuf, log_end);
|
||||
} else {
|
||||
memcpy(SYSLOG_O + UDP_PAYLOAD_OFFSET + 4, logbuf + logptr_r, logptr_w - logptr_r);
|
||||
memcpy(SYSLOG_P + 4, logbuf + log_start, log_end - log_start);
|
||||
}
|
||||
// SYSLOG_O[UDP_PAYLOAD_OFFSET + 4 + log_size - 1] = 0; // Null-terminate the payload
|
||||
|
||||
uip_len = UDP_PAYLOAD_OFFSET+4+log_size;
|
||||
tcpip_output();
|
||||
|
||||
logptr_r += log_size;
|
||||
logptr_r &= (LOGBUF_SIZE - 1);
|
||||
|
||||
uip_udp_send(log_size+4);
|
||||
logptr_r = logptr_w;
|
||||
full_line_available = 0;
|
||||
}
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user