summaryrefslogtreecommitdiffhomepage
path: root/digital/ucoolib
diff options
context:
space:
mode:
authorNicolas Schodet2013-05-01 00:31:14 +0200
committerNicolas Schodet2013-05-01 00:31:14 +0200
commit77e654cec77e28b5cead392ed34457035b5a2481 (patch)
tree64ef5fb8b7465024151b240614eb14e755f31acb /digital/ucoolib
parent61a938924954bbca81313fd50032a53f3f6fc966 (diff)
digital/ucoolib/ucoolib/dev/xmodem: add simple xmodem receiver
Diffstat (limited to 'digital/ucoolib')
-rw-r--r--digital/ucoolib/ucoolib/dev/xmodem/Module1
-rw-r--r--digital/ucoolib/ucoolib/dev/xmodem/xmodem.cc164
-rw-r--r--digital/ucoolib/ucoolib/dev/xmodem/xmodem.hh46
3 files changed, 211 insertions, 0 deletions
diff --git a/digital/ucoolib/ucoolib/dev/xmodem/Module b/digital/ucoolib/ucoolib/dev/xmodem/Module
new file mode 100644
index 00000000..37bc5ebc
--- /dev/null
+++ b/digital/ucoolib/ucoolib/dev/xmodem/Module
@@ -0,0 +1 @@
+dev_xmodem_SOURCES = xmodem.cc
diff --git a/digital/ucoolib/ucoolib/dev/xmodem/xmodem.cc b/digital/ucoolib/ucoolib/dev/xmodem/xmodem.cc
new file mode 100644
index 00000000..08e3b59c
--- /dev/null
+++ b/digital/ucoolib/ucoolib/dev/xmodem/xmodem.cc
@@ -0,0 +1,164 @@
+// ucoolib - Microcontroller object oriented library. {{{
+//
+// Copyright (C) 2013 Nicolas Schodet
+//
+// APBTeam:
+// Web: http://apbteam.org/
+// Email: team AT apbteam DOT org
+//
+// This program is free software; you can redistribute it and/or modify
+// it under the terms of the GNU General Public License as published by
+// the Free Software Foundation; either version 2 of the License, or
+// (at your option) any later version.
+//
+// This program is distributed in the hope that it will be useful,
+// but WITHOUT ANY WARRANTY; without even the implied warranty of
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+// GNU General Public License for more details.
+//
+// You should have received a copy of the GNU General Public License
+// along with this program; if not, write to the Free Software
+// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+//
+// }}}
+#include "xmodem.hh"
+#include "ucoolib/utils/delay.hh"
+#include "ucoolib/common.hh"
+
+namespace ucoo {
+
+static const char xmodem_ack = 0x06;
+static const char xmodem_c = 'C';
+static const char xmodem_nack = 0x15;
+static const char xmodem_eot = 0x04;
+static const char xmodem_soh = 0x01;
+static const char xmodem_stx = 0x02;
+static const char xmodem_can = 0x18;
+
+/// Get character with one second timeout.
+static int
+xmodem_getc (Stream &s)
+{
+ for (int timeout = 1000; timeout; timeout--)
+ {
+ int c = s.getc ();
+ if (c != -1)
+ return c;
+ delay_ms (1);
+ }
+ return -1;
+}
+
+/// Blocking putc.
+static void
+xmodem_putc (Stream &s, int c)
+{
+ s.block (true);
+ s.putc (c);
+ s.block (false);
+}
+
+/// Update CRC on received payload.
+static uint16_t
+xmodem_crc_update (uint16_t crc, uint8_t c)
+{
+ int i;
+ crc = crc ^ (c << 8);
+ for (i = 0; i < 8; i++)
+ {
+ if (crc & 0x8000)
+ crc = (crc << 1) ^ 0x1021;
+ else
+ crc = (crc << 1);
+ }
+ return crc;
+}
+
+int
+xmodem_receive (Stream &s, XmodemReceiver &receiver)
+{
+ int i, length, total = 0;
+ int c, c2;
+ uint16_t crc;
+ bool started = false;
+ bool ok = false;
+ uint8_t block_number = 1;
+ bool dup = false;
+ char buf[1024];
+ s.block (false);
+ while (1)
+ {
+ // Send ACK, NACK or 'C'.
+ if (ok)
+ xmodem_putc (s, xmodem_ack);
+ else
+ {
+ // Purge.
+ while (xmodem_getc (s) != -1)
+ ;
+ xmodem_putc (s, started ? xmodem_nack : xmodem_c);
+ }
+ ok = false;
+ // Receive SOH, STX, or EOT.
+ c = xmodem_getc (s);
+ if (c == xmodem_soh)
+ length = 128;
+ else if (c == xmodem_stx)
+ length = 1024;
+ else if (c == xmodem_eot)
+ break;
+ else
+ continue;
+ // Receive block number.
+ c = xmodem_getc (s);
+ if (c == -1)
+ continue;
+ c2 = xmodem_getc (s);
+ if (c2 == -1 || c2 != 255 - c)
+ continue;
+ else if (started && c == block_number - 1)
+ dup = true;
+ else if (c != block_number)
+ continue;
+ // Receive data.
+ crc = 0;
+ for (i = 0; i < length && c != -1; i++)
+ {
+ c = xmodem_getc (s);
+ crc = xmodem_crc_update (crc, c);
+ buf[i] = c;
+ }
+ if (c == -1)
+ continue;
+ // Receive CRC.
+ c = xmodem_getc (s);
+ if (c == -1)
+ continue;
+ crc = xmodem_crc_update (crc, c);
+ c = xmodem_getc (s);
+ if (c == -1)
+ continue;
+ crc = xmodem_crc_update (crc, c);
+ if (crc != 0)
+ continue;
+ // Success, handle data.
+ if (!dup)
+ {
+ started = true;
+ block_number++;
+ int r = receiver.write (buf, length);
+ if (r == -1)
+ {
+ total = -1;
+ break;
+ }
+ total += length;
+ }
+ ok = true;
+ dup = false;
+ }
+ xmodem_putc (s, total == -1 ? xmodem_can : xmodem_ack);
+ return total;
+}
+
+} // namespace ucoo
diff --git a/digital/ucoolib/ucoolib/dev/xmodem/xmodem.hh b/digital/ucoolib/ucoolib/dev/xmodem/xmodem.hh
new file mode 100644
index 00000000..f74c1b6a
--- /dev/null
+++ b/digital/ucoolib/ucoolib/dev/xmodem/xmodem.hh
@@ -0,0 +1,46 @@
+#ifndef ucoolib_dev_xmodem_xmodem_hh
+#define ucoolib_dev_xmodem_xmodem_hh
+// ucoolib - Microcontroller object oriented library. {{{
+//
+// Copyright (C) 2013 Nicolas Schodet
+//
+// APBTeam:
+// Web: http://apbteam.org/
+// Email: team AT apbteam DOT org
+//
+// This program is free software; you can redistribute it and/or modify
+// it under the terms of the GNU General Public License as published by
+// the Free Software Foundation; either version 2 of the License, or
+// (at your option) any later version.
+//
+// This program is distributed in the hope that it will be useful,
+// but WITHOUT ANY WARRANTY; without even the implied warranty of
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+// GNU General Public License for more details.
+//
+// You should have received a copy of the GNU General Public License
+// along with this program; if not, write to the Free Software
+// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
+//
+// }}}
+#include "ucoolib/intf/stream.hh"
+
+namespace ucoo {
+
+/// Handle data received from XMODEM.
+class XmodemReceiver
+{
+ public:
+ /// Write up to COUNT bytes of data from BUF to stream. Return the number
+ /// of written bytes or -1 on error.
+ virtual int write (const char *buf, int count) = 0;
+};
+
+/// Make a XMODEM reception from stream and write any received data to
+/// receiver.
+int
+xmodem_receive (Stream &s, XmodemReceiver &receiver);
+
+} // namespace ucoo
+
+#endif // ucoolib_dev_xmodem_xmodem_hh