X-Git-Url: http://git.joshuawise.com/netwatch.git/blobdiff_plain/4f171920f824ffca9a27eb5d25a4547ae0a5465a..779b8ca85ab0f4cc686f9bb3ffe622fef404b99e:/net/rfb.c diff --git a/net/rfb.c b/net/rfb.c index 70d2c05..e86f03d 100644 --- a/net/rfb.c +++ b/net/rfb.c @@ -2,8 +2,7 @@ #include #include #include - -#include "../aseg-paging/keyboard.h" +#include #include "lwip/tcp.h" #include "lwip/stats.h" @@ -17,9 +16,9 @@ #define POINTER_EVENT 5 #define CLIENT_CUT_TEXT 6 -#define RFB_BUF_SIZE 64 +#define RFB_BUF_SIZE 512 -#define SCREEN_CHUNKS_X 16 +#define SCREEN_CHUNKS_X 8 #define SCREEN_CHUNKS_Y 8 struct pixel_format { @@ -94,7 +93,7 @@ struct update_header { struct rfb_state { enum { - ST_BEGIN, + ST_BEGIN = 0, ST_CLIENTINIT, ST_MAIN } state; @@ -111,12 +110,12 @@ struct rfb_state { struct fb_update_req client_interest_area; enum { - SST_IDLE, - SST_NEEDS_UPDATE, - SST_SENDING + SST_IDLE = 0, + SST_HEADER, + SST_DATA } send_state; - uint32_t checksums[SCREEN_CHUNKS_Y][SCREEN_CHUNKS_X]; + uint32_t checksums[SCREEN_CHUNKS_X][SCREEN_CHUNKS_Y]; uint32_t chunk_xnum; uint32_t chunk_ynum; @@ -126,6 +125,11 @@ struct rfb_state { uint32_t chunk_height; uint32_t chunk_lindex; + + uint32_t chunk_checksum; + + int chunk_actually_sent; + int try_in_a_bit; }; static struct server_init_message server_info; @@ -162,155 +166,153 @@ static void update_server_info() { } } +static int advance_chunk(struct rfb_state *state) { + + state->chunk_xnum += 1; + + if (state->chunk_xnum == SCREEN_CHUNKS_X) { + state->chunk_ynum += 1; + state->chunk_xnum = 0; + } + + if (state->chunk_ynum == SCREEN_CHUNKS_Y) { + state->chunk_ynum = 0; + state->send_state = SST_IDLE; + if (!(state->chunk_actually_sent)) + state->try_in_a_bit = 2; + return 1; + } + + return 0; +} + static void send_fsm(struct tcp_pcb *pcb, struct rfb_state *state) { struct update_header hdr; int lines_left; - char * lptr; + unsigned char * lptr; int totaldim; err_t err; - switch (state->send_state) { - case SST_IDLE: - /* Nothing to do */ - if (state->update_requested) { - outputf("RFB send: update requested"); - state->update_requested = 0; - state->send_state = SST_NEEDS_UPDATE; - } else { - break; - } - - /* FALL THROUGH to SST_NEEDS_UPDATE */ + while(1) { - case SST_NEEDS_UPDATE: + switch (state->send_state) { - state->chunk_xnum = 0; - state->chunk_ynum = 0; - state->chunk_width = 0; - state->chunk_height = 0; - state->chunk_lindex = 0; - state->send_state = SST_SENDING; + case SST_IDLE: + /* Nothing to do */ - /* FALL THROUGH to SST_SENDING */ + if (state->update_requested) { + outputf("RFB send: update requested"); + state->update_requested = 0; + state->chunk_actually_sent = 0; + state->send_state = SST_HEADER; + } else { + return; + } + + /* FALL THROUGH to SST_HEADER */ + + case SST_HEADER: + + /* Calculate the width and height for this chunk, remembering + * that if SCREEN_CHUNKS_[XY] do not evenly divide the width and + * height, we may need to have shorter chunks at the edge of + * the screen. */ + + state->chunk_width = fb->curmode.xres / SCREEN_CHUNKS_X; + if (fb->curmode.xres % SCREEN_CHUNKS_X != 0) + state->chunk_width += 1; + state->chunk_xpos = state->chunk_width * state->chunk_xnum; + totaldim = state->chunk_width * (state->chunk_xnum + 1); + if (totaldim > fb->curmode.xres) { + state->chunk_width -= (totaldim - fb->curmode.xres); + } - case SST_SENDING: + state->chunk_height = fb->curmode.yres / SCREEN_CHUNKS_Y; + if (fb->curmode.yres % SCREEN_CHUNKS_Y != 0) + state->chunk_height += 1; + state->chunk_ypos = state->chunk_height + * state->chunk_ynum; + totaldim = state->chunk_height * (state->chunk_ynum + 1); + if (totaldim > fb->curmode.yres) { + state->chunk_height -= (totaldim - fb->curmode.yres); + } - while (1) { - lines_left = state->chunk_height - state->chunk_lindex; + /* Do we _actually_ need to send this chunk? */ + if (fb->checksum_rect) { + state->chunk_checksum = fb->checksum_rect(state->chunk_xpos, state->chunk_ypos, + state->chunk_width, state->chunk_height); - if (lines_left == 0) { - outputf("RFB: (%d [%d], %d [%d]), advancing", - state->chunk_xnum, state->chunk_xpos, - state->chunk_ynum, state->chunk_ypos); + if (state->chunk_checksum == state->checksums[state->chunk_xnum][state->chunk_ynum]) { + if (advance_chunk(state)) + return; + continue; + } + /* Checksum gets set in data block, AFTER the data has been sent. */ + } - /* Advance to the next chunk if necessary. If - * state->chunk_height is zero, then we are - * arriving here for the first time from - * SST_NEEDS_UPDATE. */ + outputf("actually sent"); + state->chunk_actually_sent = 1; - if (state->chunk_height != 0) { - state->chunk_xnum += 1; - } + /* Send a header */ + hdr.msgtype = 0; + state->chunk_lindex = 0; + hdr.nrects = htons(1); + hdr.xpos = htons(state->chunk_xpos); + hdr.ypos = htons(state->chunk_ypos); + hdr.width = htons(state->chunk_width); + hdr.height= htons(state->chunk_height); + hdr.enctype = htonl(0); + lines_left = state->chunk_height; - if (state->chunk_xnum == SCREEN_CHUNKS_X) { - state->chunk_ynum += 1; - state->chunk_xnum = 0; - } + err = tcp_write(pcb, &hdr, sizeof(hdr), TCP_WRITE_FLAG_COPY); - if (state->chunk_ynum == SCREEN_CHUNKS_Y) { - state->send_state = SST_IDLE; - break; - } + if (err != ERR_OK) { + if (err != ERR_MEM) + outputf("RFB: header send error %d", err); - outputf("RFB send: sending header"); + /* Try again later. */ + return; + } - /* Calculate the width and height for this chunk, remembering - * that if SCREEN_CHUNKS_[XY] do not evenly divide the width and - * height, we may need to have shorter chunks at the edge of - * the screen. */ + state->send_state = SST_DATA; - state->chunk_width = fb->curmode.xres / SCREEN_CHUNKS_X; - if (fb->curmode.xres % SCREEN_CHUNKS_X != 0) - state->chunk_width += 1; - state->chunk_xpos = state->chunk_width * state->chunk_xnum; - totaldim = state->chunk_width * (state->chunk_xnum + 1); - if (totaldim > fb->curmode.xres) { - state->chunk_width -= (totaldim - fb->curmode.xres); - } + /* FALL THROUGH to SST_DATA */ - state->chunk_height = fb->curmode.yres / SCREEN_CHUNKS_Y; - if (fb->curmode.yres % SCREEN_CHUNKS_Y != 0) - state->chunk_height += 1; - state->chunk_ypos = state->chunk_height - * state->chunk_ynum; - totaldim = state->chunk_height * (state->chunk_ynum + 1); - if (totaldim > fb->curmode.yres) { - state->chunk_height -= (totaldim - fb->curmode.yres); - } + case SST_DATA: - /* Send a header */ - hdr.msgtype = 0; - hdr.nrects = htons(1); - hdr.xpos = htons(state->chunk_xpos); - hdr.ypos = htons(state->chunk_ypos); - hdr.width = htons(state->chunk_width); - hdr.height= htons(state->chunk_height); - hdr.enctype = htonl(0); - state->chunk_lindex = 0; - lines_left = state->chunk_height; - - err = tcp_write(pcb, &hdr, sizeof(hdr), TCP_WRITE_FLAG_COPY); - - if (err != ERR_OK) { - if (err != ERR_MEM) - outputf("RFB: header send error %d", err); - - /* Crap. Reset chunk_height to 0 so that next time around, - * we'll recalculate this chunk (not advance) and try to - * send the header again. - */ - state->chunk_height = 0; - } + lines_left = state->chunk_height - state->chunk_lindex; + + if (lines_left == 0) { + state->send_state = SST_HEADER; + state->checksums[state->chunk_xnum][state->chunk_ynum] = state->chunk_checksum; + if (advance_chunk(state)) + return; + break; } - do { - outputf("RFB: (%d [%d], %d [%d]), %d x %d, line %d", - state->chunk_xnum, state->chunk_xpos, - state->chunk_ynum, state->chunk_ypos, - state->chunk_width, state->chunk_height, - state->chunk_lindex); - - lptr = fb->fbaddr - + (fb->curmode.xres * fb->curmode.bytestride - * (state->chunk_ypos + state->chunk_lindex)) - + (state->chunk_xpos * fb->curmode.bytestride); - - /* The network card can't DMA from video RAM, - * so use TCP_WRITE_FLAG_COPY. */ - err = tcp_write(pcb, lptr, - fb->curmode.bytestride * state->chunk_width, - TCP_WRITE_FLAG_COPY); - - if (err == ERR_OK) { - state->chunk_lindex += 1; - } + lptr = fb->fbaddr + + (fb->curmode.xres * fb->curmode.bytestride + * (state->chunk_ypos + state->chunk_lindex)) + + (state->chunk_xpos * fb->curmode.bytestride); - } while (err == ERR_OK && state->chunk_lindex < state->chunk_height); + /* The network card can't DMA from video RAM, + * so use TCP_WRITE_FLAG_COPY. */ + err = tcp_write(pcb, lptr, + fb->curmode.bytestride * state->chunk_width, TCP_WRITE_FLAG_COPY); - if (err != ERR_OK) { + if (err == ERR_OK) { + state->chunk_lindex += 1; + } else { if (err != ERR_MEM) outputf("RFB: send error %d", err); - outputf("RFB: that's all for now"); - break; + return; } if (tcp_sndbuf(pcb) == 0) { - break; + return; } } - - break; } if (tcp_output(pcb) != ERR_OK) @@ -326,16 +328,26 @@ static err_t rfb_sent(void *arg, struct tcp_pcb *pcb, uint16_t len) { static err_t rfb_poll(void *arg, struct tcp_pcb *pcb) { struct rfb_state *state = arg; send_fsm(pcb, state); + if (state->try_in_a_bit) { + state->try_in_a_bit--; + if (!(state->try_in_a_bit)) { + state->update_requested = 1; + } + } +/* stats_display(); +*/ return ERR_OK; } static void close_conn(struct tcp_pcb *pcb, struct rfb_state *state) { + outputf("close_conn: bailing"); tcp_arg(pcb, NULL); tcp_sent(pcb, NULL); tcp_recv(pcb, NULL); mem_free(state); tcp_close(pcb); + outputf("close_conn: done"); } enum fsm_result { @@ -487,17 +499,18 @@ static enum fsm_result recv_fsm(struct tcp_pcb *pcb, struct rfb_state *state) { (struct text_event_pkt *)state->data; if (state->writepos < sizeof(struct text_event_pkt) - + pkt->length) + + pkt->length) return NEEDMORE; /* XXX stub */ state->readpos += sizeof(struct text_event_pkt) - + pkt->length; + + pkt->length; return OK; default: outputf("RFB: Bad command: %d", state->data[0]); + return FAIL; } default: outputf("RFB: Bad state"); @@ -506,8 +519,9 @@ static enum fsm_result recv_fsm(struct tcp_pcb *pcb, struct rfb_state *state) { } static err_t rfb_recv(void *arg, struct tcp_pcb *pcb, - struct pbuf *p, err_t err) { + struct pbuf *p, err_t err) { struct rfb_state *state = arg; + uint16_t copylen; if (state == NULL) @@ -530,8 +544,8 @@ static err_t rfb_recv(void *arg, struct tcp_pcb *pcb, return ERR_OK; } - outputf("RFB: Processing %d", p->tot_len); - pbuf_copy_partial(p, state->data + state->writepos, p->tot_len, 0); + copylen = pbuf_copy_partial(p, state->data + state->writepos, p->tot_len, 0); + outputf("RFB: Processing %d, wp %d, cp %d", p->tot_len, state->writepos, copylen); state->writepos += p->tot_len; tcp_recved(pcb, p->tot_len); @@ -541,26 +555,21 @@ static err_t rfb_recv(void *arg, struct tcp_pcb *pcb, switch (recv_fsm(pcb, state)) { case NEEDMORE: outputf("RFB FSM: blocking"); - /* Need more data */ - return ERR_OK; + goto doneprocessing; case OK: outputf("RFB FSM: ok"); - /* Kick off a send. */ - if (state->send_state == SST_IDLE - && state->update_requested) { - send_fsm(pcb, state); - } - if (state->readpos == state->writepos) { state->readpos = 0; state->writepos = 0; - return ERR_OK; + goto doneprocessing; } else { memmove(state->data, - state->data + state->readpos, - state->writepos - state->readpos); + state->data + state->readpos, + state->writepos - state->readpos); + state->writepos -= state->readpos; + state->readpos = 0; } break; case FAIL: @@ -570,6 +579,15 @@ static err_t rfb_recv(void *arg, struct tcp_pcb *pcb, return ERR_OK; } } + +doneprocessing: + + /* Kick off a send. */ + if (state->send_state == SST_IDLE && state->update_requested) { + send_fsm(pcb, state); + } + + return ERR_OK; } static err_t rfb_accept(void *arg, struct tcp_pcb *pcb, err_t err) { @@ -580,10 +598,9 @@ static err_t rfb_accept(void *arg, struct tcp_pcb *pcb, err_t err) { state = (struct rfb_state *)mem_malloc(sizeof(struct rfb_state)); + memset(state, 0, sizeof(struct rfb_state)); + state->state = ST_BEGIN; - state->readpos = 0; - state->writepos = 0; - state->update_requested = 0; state->send_state = SST_IDLE; /* XXX: update_server_info() should be called from the 64ms timer, and deal