+static void send_fsm(struct tcp_pcb *pcb, struct rfb_state *state) {
+ struct update_header hdr;
+ int lines_left;
+ char * lptr;
+ uint32_t checksum;
+ 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 */
+
+ case SST_NEEDS_UPDATE:
+
+ 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;
+
+ /* FALL THROUGH to SST_SENDING */
+
+ case SST_SENDING:
+
+ while (1) {
+ lines_left = state->chunk_height - state->chunk_lindex;
+
+ if (lines_left == 0) {
+ /* 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. */
+
+ if (state->chunk_height != 0) {
+ 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->send_state = SST_IDLE;
+ outputf("RFB: Screen update done! %d", state->update_requested);
+ break;
+ }
+
+ /* 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);
+ }
+
+ 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);
+ }
+
+ if (fb->checksum_rect) {
+ checksum = fb->checksum_rect(state->chunk_xpos, state->chunk_ypos,
+ state->chunk_width, state->chunk_height);
+
+ if (checksum == state->checksums[state->chunk_xnum][state->chunk_ynum]) {
+ state->chunk_lindex = state->chunk_height;
+ continue;
+ } else {
+ state->checksums[state->chunk_xnum][state->chunk_ynum] = checksum;
+ }
+ }
+/*
+ outputf("RFB send: sending header");
+*/
+ /* 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;
+
+ 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;
+ }
+ }
+
+ do {
+ 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;
+ }
+
+ } while (err == ERR_OK && state->chunk_lindex < state->chunk_height);
+
+ if (err != ERR_OK) {
+ if (err != ERR_MEM)
+ outputf("RFB: send error %d", err);
+
+ break;
+ }
+
+ if (tcp_sndbuf(pcb) == 0) {
+ break;
+ }
+ }
+
+ break;
+ }
+
+ if (tcp_output(pcb) != ERR_OK)
+ outputf("RFB: tcp_output bailed in send_fsm?");
+}
+
+static err_t rfb_sent(void *arg, struct tcp_pcb *pcb, uint16_t len) {
+ struct rfb_state *state = arg;
+ send_fsm(pcb, state);
+ return ERR_OK;
+}
+
+static err_t rfb_poll(void *arg, struct tcp_pcb *pcb) {
+ struct rfb_state *state = arg;
+ state->update_requested = 1;
+ send_fsm(pcb, state);
+/*
+ stats_display();
+*/
+ return ERR_OK;
+}
+
git.joshuawise.com / netwatch.git / blobdiff