|
YMODEM协议串口文件传输 GitHub仓库:http://github.com/XinLiGitHub/SerialPortYmodem% Y! Y! l j# x+ {1 E: e
PS:博文不再更新,后续更新会在GitHub仓库进行。
- l$ t1 ^( G) ?) K# g9 q7 E
$ \ n# f- n5 h" d# s
3 P0 x/ x% s P$ l/ |9 h 串口通过YMODEM协议进行文件传输。程序中涉及到YMODEM协议知识,详细介绍见维基百科[YMODEM](http://en.wikipedia.org/wiki/YMODEM)。+ _, E2 b5 c4 ], Y% \7 F0 j% Y% ]- }
5 ]- W) K# [3 ]* W/ {" B1,开发环境
7 n, u1 c, E( z0 d% s 1,框架:Qt 5.7.1
: l% O) X% ~9 r9 c- _7 s$ C; O( i- M9 R! R' K) H' M' X
2,编译器:MSVC2015_64bit
+ D# X" @5 o4 ~+ E9 C1 b7 A, U7 q( u7 t: {
3,IDE:Qt Creator 4.2.0 社区版
/ g4 g; r$ p% A5 { 4,操作系统:Windows 10 专业版
1 _0 M! T- D& ~ z7 ]- G: \9 I/ o$ E
2,程序源码
, |1 {9 K9 K z; C Ymodem.h文件
! U* @7 O2 O. s& A( F0 S- /**
& s0 a6 r h6 q7 W9 K - ******************************************************************************
, ]! X4 @: B- B& k; T7 o! Y - * @file Ymodem.h0 v" \0 \ X2 u' d$ B
- * @author XinLi ^% r4 ^( V+ y- Z
- * @version v1.0
) T9 L& o# H' `1 x) H: M# b* l- }4 M - * @date 21-January-20188 e& D$ a$ b9 ^6 ?3 c C
- * @brief Header file for Ymodem.cpp module.
" C: K" L+ {6 w2 M - ******************************************************************************' v; p* u Q9 M; l E
- * @attention
" j. W: N& m. L - *
4 [& d4 @; }( L5 T4 ] - * <h2><center>Copyright © 2018 XinLi</center></h2>
1 @. `* ^* `( H& z5 C9 \ - *9 _, R9 x5 S5 `) S" J5 Z6 f
- * This program is free software: you can redistribute it and/or modify
7 J0 T2 ?; N. q9 R) }0 ^/ n; ? - * it under the terms of the GNU General Public License as published by* A# H2 v9 K$ D4 P/ y8 O% g/ e2 }
- * the Free Software Foundation, either version 3 of the License, or
( y) P4 ^+ N, l/ w - * (at your option) any later version.3 y' x+ P2 @1 A, D
- *
2 }4 ~$ \$ h8 N8 S% f" ?* t0 p - * This program is distributed in the hope that it will be useful,
9 ~0 q' |# _3 w0 F - * but WITHOUT ANY WARRANTY; without even the implied warranty of
! r R- ], @& o; x' E: D - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
; B7 b# m0 G- a3 M6 y - * GNU General Public License for more details.
# u3 N2 J/ p% d1 @ - *
& @/ D/ u7 Q8 H3 ` v7 b' R3 V4 N - * You should have received a copy of the GNU General Public License) N, b8 e& A* A# U; Q
- * along with this program. If not, see <http://www.gnu.org/licenses/>.
! |+ A& X9 u# u6 o - *9 ?. p7 o2 H8 I; A! Q
- ******************************************************************************% W% g+ b3 j( M/ i
- *// u! s# |+ O! v: k& f4 d
6 N7 |1 T$ i: ?. g, x5 H0 y6 l- #ifndef __YMODEM_H# a, F. f. j+ w( s: i- t" o
- #define __YMODEM_H) w! I6 W: F/ N/ y1 _5 y
2 h: y/ P% |- i% \0 R' f! u- /* Header includes -----------------------------------------------------------*/0 ]7 m5 N7 _& |$ p( P3 {- M- \% W7 u
- #include <stdint.h>
h8 r8 W% I1 y v( ]$ M
6 E" d5 I# g) T6 V# H' `7 p- /* Macro definitions ---------------------------------------------------------*/
1 |+ B A2 w3 i6 R, K& K e2 K - #define YMODEM_PACKET_HEADER (3)
* f, ~6 L, t3 H5 ^( u" e7 H; x - #define YMODEM_PACKET_TRAILER (2). [, Z8 O$ u' {7 Y6 w# L
- #define YMODEM_PACKET_OVERHEAD (YMODEM_PACKET_HEADER + YMODEM_PACKET_TRAILER)5 ]( x0 T5 L/ j* g. B
- #define YMODEM_PACKET_SIZE (128)
0 }; A% n8 p6 B: x; R8 u - #define YMODEM_PACKET_1K_SIZE (1024)* t( V$ p8 X D( {& w
7 H' E y1 t) n- #define YMODEM_CODE_CAN_NUMBER (5). i2 q- T( T8 U" z- i* {% s/ S5 t
% K3 s# z# V, x. q# w4 T3 ?. Y- /* Type definitions ----------------------------------------------------------*/0 ~% e; m% \5 `+ O* f; m) h$ G/ N
- class Ymodem
/ {% V/ d: `; K2 z - {
/ U2 _; ?. S/ m5 A# }* j - public:
( ~/ c* \- h. c' u3 [6 S - enum Code5 G5 G K3 B: e3 j( Y+ W
- {0 Q+ H/ @& a- i( q& {
- CodeNone = 0x00,
3 V+ o. ^- O* W; t+ K& J' B% l; z - CodeSoh = 0x01,' b: U* h$ z3 T" f% a/ }" Y
- CodeStx = 0x02,9 [: W! k4 b. b0 i1 C3 _
- CodeEot = 0x04,: H7 F& I0 Z0 B X9 p3 e, Z3 I: w
- CodeAck = 0x06,
4 p* D5 i4 A2 F+ a0 f, ^ - CodeNak = 0x15,
! X$ F6 E* [1 a) y; q4 t1 C1 c - CodeCan = 0x18,2 U( @& v% ]8 T% B2 F1 \' `( ?4 [
- CodeC = 0x43,
- r5 N: D) g L+ U' v - CodeA1 = 0x41,! R- b' u7 Q# i" `
- CodeA2 = 0x616 m, y6 {+ l$ v6 N$ S; E) G8 t! E
- }; H( n9 |9 x$ m& R) S
1 z2 \' Z; W) m$ n- enum Stage
( W9 e& }9 H2 z( q - {- Q% V8 }6 o) T/ L9 g' m
- StageNone,
7 d2 b4 n ~- {- x" ~. u* v - StageEstablishing,
$ s5 Q5 }) h: z. S6 y - StageEstablished,
. G8 D* L+ g Y0 K$ j5 C9 b+ n2 \ - StageTransmitting,
+ M+ K% e8 d. K7 E: Y; w& {* v; R - StageFinishing,
$ R, C8 j& o9 G! \3 ^ - StageFinished7 G/ s ?4 C8 {* ~
- };
: `! k9 r" A# _. c6 S1 A' ]- | - # j: z4 e$ L) V0 T; B+ O; x
- enum Status( s0 n5 Q5 P, q& n3 n5 S$ A
- {9 X* q) F2 h) r" d/ K( G- v5 @; x
- StatusEstablish,) x* j& z# C. |& t7 C2 L2 [( ]1 v" R
- StatusTransmit,
' n) v/ v6 G. b; y0 l - StatusFinish,
, M; m K& O u1 b3 u4 B2 m - StatusAbort,( c: c6 E$ e9 t; q: W m* s" v% P
- StatusTimeout,
5 D0 F1 @" y0 I - StatusError
- K ~, @' e! {& a" U - };
2 z V( R7 U# x6 j! e9 f
) R) h8 |2 a4 l$ q- Ymodem(uint32_t timeDivide = 499, uint32_t timeMax = 5, uint32_t errorMax = 999);
5 n( v# d- M: z0 F
3 W% D5 R3 @; f9 Z- void setTimeDivide(uint32_t timeDivide);. f9 f) K/ X( i1 v; c- b; v8 E. ^
- uint32_t getTimeDivide();3 Z' V9 w* R# l
' Y5 @+ |1 [/ t; |" a/ P- void setTimeMax(uint32_t timeMax);
6 T4 M2 H* J7 p( V - uint32_t getTimeMax();
1 ~: B3 N0 V" j' s) F: V8 q
v; r+ i1 Z8 [& K- void setErrorMax(uint32_t errorMax);6 B5 ~5 P0 p( ]4 Z6 `; |: F) ~9 _
- uint32_t getErrorMax();+ `( A9 [) f& F# W) F
" Y V4 |3 ~: F$ z; o6 j- void receive();, Y6 m, W7 f. K+ g8 v! q
- void transmit();
, I1 Y1 N$ N' ~) P - void abort();9 X6 [/ v/ a- D+ r1 t
4 x v! y. W' o! |3 ^- private:" l- O/ o: p& u* R2 b: @
- Code receivePacket();) o0 L' i. l3 j7 S
" A+ Z" \' M' @- M M, J% n3 P2 ]2 P6 `- void receiveStageNone();2 Z( T2 j- q U/ F
- void receiveStageEstablishing();! g' d# L1 l+ E1 J# y1 i
- void receiveStageEstablished();
O3 L, ?/ m5 W& A: _% Y - void receiveStageTransmitting();/ ~2 h0 V0 \9 A. w/ j6 N0 S
- void receiveStageFinishing();# u# m& G* r2 d1 O& F
- void receiveStageFinished();, U" H2 ], [4 y7 E# D# ^
- ) ^& H! V7 Z1 Y* d
- void transmitStageNone();' U6 p8 F; t3 E3 l
- void transmitStageEstablishing();5 Q, X% A7 U- D# b0 o1 o8 U$ k. l
- void transmitStageEstablished();7 x/ W; a4 X9 `0 [4 Q. y
- void transmitStageTransmitting();% `' T$ G- [; f1 I2 Q. X, W
- void transmitStageFinishing();- v- T4 D7 R8 N& O2 o" r+ g
- void transmitStageFinished();
9 p: F1 U% q' O) }$ j" i! q - 9 n, d; p$ M' D4 P& E$ ?7 j5 G
- uint16_t crc16(uint8_t *buff, uint32_t len);+ F- O1 ^, o- S0 q
- ' {& E; @. Z7 Y0 N6 f8 e7 f
- virtual Code callback(Status status, uint8_t *buff, uint32_t *len) = 0;
" L' C2 b% a, e3 u
2 q& E2 J! Q* ~: D# E9 w: ~# T- virtual uint32_t read(uint8_t *buff, uint32_t len) = 0;; }3 f) z( M L. v* a) H
- virtual uint32_t write(uint8_t *buff, uint32_t len) = 0;
( `* X2 f' m2 O* L3 H - 6 \' x% J8 x; M& R
- uint32_t timeDivide;9 X8 X( ~7 x0 K* [3 k1 w5 l* Y
- uint32_t timeMax;
0 i# F- O3 b2 p7 \, t$ h( ] - uint32_t errorMax;! m: r4 K, {2 ~4 l. g: f4 @
3 p" P6 B& s: e4 v, X- uint32_t timeCount;' q( b9 g6 w1 l: i: q- }
- uint32_t errorCount; `2 D Q% }# p0 @* s
- uint8_t dataCount;. E) b4 e, [: S
- ; B) U! B) L- G' T# i
- Code code;& j$ \6 N/ b3 c, T
- Stage stage;, v( \+ T0 R$ `' M2 o8 M$ N
- ! u7 {3 O9 s; Q+ ]4 R
- uint8_t rxBuffer[YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD];3 G5 r& J* e! i: F M- j/ l
- uint8_t txBuffer[YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD];. } k2 d9 G( Z8 q' a
- uint32_t rxLength;
8 [5 q# r/ ?' q c H9 { - uint32_t txLength;' Q" T. _) V1 b: H
- };
+ J% P& M6 V' O! |/ Y6 u
* s! {# F0 h' ~; Z2 e$ }+ F- /* Variable declarations -----------------------------------------------------*/
+ [' B1 F5 O8 K5 t) ~/ a1 a - /* Variable definitions ------------------------------------------------------*/# g* D9 o3 {3 H/ W3 q
- /* Function declarations -----------------------------------------------------*/+ @7 `" O$ J3 Z- S$ ~
- /* Function definitions ------------------------------------------------------*/% O* x" B( V' }6 j% i1 T; Q8 o9 X, m
- + N4 l8 g6 l! F! b
- #endif /* __YMODEM_H */& h( G) `9 S7 M9 p* C
复制代码
; d) |5 q; z6 w) u% P% a6 z/ N Ymodem.cpp文件
. v2 F7 \5 J& P' d+ K2 c" {- /**; O: u9 ~- q2 f. r
- ******************************************************************************2 D3 S% R; N$ E6 G4 y
- * @file Ymodem.cpp- X' U! x$ l$ G
- * @author XinLi' c5 e2 }' W# v: a1 k
- * @version v1.0
8 s- _3 U$ }7 r5 o: x. }3 [- d - * @date 21-January-2018( W' d0 h3 k% v0 ^( W" x
- * @brief Ymodem protocol module source file.
3 B1 o8 ]4 v* n6 {3 | - ******************************************************************************( N9 w- U8 { P' d
- * @attention" p3 L; [, z# w9 r3 J4 }
- *. u: {4 q/ f: S% C% d0 _
- * <h2><center>Copyright © 2018 XinLi</center></h2>
$ g; y7 F0 F5 ? - *
' `2 c* e# W- N# U. x, k t# T - * This program is free software: you can redistribute it and/or modify* D+ ^. R# }1 n/ s$ `
- * it under the terms of the GNU General Public License as published by
. t5 ~6 V' e8 c6 D" g7 [6 M - * the Free Software Foundation, either version 3 of the License, or/ M7 a* M- f- y3 r8 B
- * (at your option) any later version.
; I+ R# J" d6 p0 E3 m - *
4 I$ g) f) P3 H7 m$ E - * This program is distributed in the hope that it will be useful,
! I8 D5 k1 y2 | - * but WITHOUT ANY WARRANTY; without even the implied warranty of
- C' h* Q. f9 `& H4 l* [! | - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
' g/ J" f6 I {/ C! L5 p! b4 p - * GNU General Public License for more details.( s# y# c Q: D6 c: E+ w' H4 H
- *
, a ]$ s. h$ W# R! d' R4 y - * You should have received a copy of the GNU General Public License
" B1 ?/ ?: X4 F8 Z9 y - * along with this program. If not, see <http://www.gnu.org/licenses/>. O+ s4 k$ X" K+ Z1 C+ p* X
- *0 D+ N# n5 d' \; `' k4 m
- ******************************************************************************
* U5 s" V2 i0 N/ z0 g/ ? - */& x; b0 z* R5 U5 R/ \ \/ x3 g" ^' [
7 |5 ]2 _+ Q9 p8 d& n- /* Header includes -----------------------------------------------------------*/$ I z; P: h3 p; W3 P6 C8 P9 T
- #include "Ymodem.h"0 F& U& s& a$ W% z
- #include <string.h>
& H# i5 a! a7 x& O7 z. t) ~ - ( j9 ?3 c4 L- L2 T5 M
- /* Macro definitions ---------------------------------------------------------*/% t+ x& _$ t6 W* U. u& K
- /* Type definitions ----------------------------------------------------------*/8 Y% l! `! [ u! R, W- I
- /* Variable declarations -----------------------------------------------------*/3 y7 {+ k# ]6 C! r
- /* Variable definitions ------------------------------------------------------*/9 I/ _3 Z* z" r, r3 q [
- /* Function declarations -----------------------------------------------------*// r# [! g! y3 {& j$ F6 b$ v
- /* Function definitions ------------------------------------------------------*/
1 c6 g) ?3 H) s/ g
3 l% ^6 z) G1 b1 D) F: C- /**: R* n+ p: d' q5 T ^; ?, |$ r
- * @brief Ymodem constructor., L8 ^# L3 I# y& k/ [4 \9 u
- * @param [in] timeDivide: The fractional factor of the time the ymodem is called.
/ `& u9 m6 E7 O+ J9 I - * @param [in] timeMax: The maximum time when calling the ymodem.0 K. P3 M, ]4 R7 ^
- * @param [in] errorMax: The maximum error count when calling the ymodem.
) M: I3 T) ]4 @! b2 q E: Y - * @note The longest waiting time = call time / (@timeDivide + 1) * (@timeMax + 1).& z. m+ y- }) _ i4 h; ]
- * @return None.
. T2 M# ~% N. t4 G- h - */
; ?# g: K# ]2 i& } - Ymodem::Ymodem(uint32_t timeDivide, uint32_t timeMax, uint32_t errorMax)0 U9 [: B- `2 c, p( [5 N: G& U
- {
, `. U2 k" Z5 W$ d- I - this->timeDivide = timeDivide;
$ F" x" N( E% w5 P& c* ]: P - this->timeMax = timeMax;
* u# B* [# D8 Q! M* f - this->errorMax = errorMax;0 l- v8 T* ^) g
. r$ ]1 {) M F3 H6 Y$ o- L- this->timeCount = 0;
/ J; b- Q2 W I9 f - this->errorCount = 0;
" V/ x1 i5 Z1 Q$ }; C3 ]1 O, h, l" l - this->dataCount = 0;
& |# M; [! l* K" b8 Z - ; f. F) k6 [, ^( V% i) h) [
- this->code = CodeNone;. v% l4 D- C$ Z* T3 ]1 R! i% a2 s
- this->stage = StageNone;, Z5 J! D' d, s, [
- } s( ^& h9 k p/ @4 T6 w4 z
1 v& Z3 t' Z. J' ?1 c- /**" q8 {" N/ P6 P- ]
- * @brief Set the fractional factor of the time the ymodem is called.
/ t7 v/ ~; Q; u4 C - * @param [in] timeDivide: The fractional factor of the time the ymodem is called.
& H& _5 s$ q# O% L - * @return None.1 {: f- J: }- g0 T
- */
; ]- D5 m+ T7 c2 Z/ Q$ v5 ]& r% C - void Ymodem::setTimeDivide(uint32_t timeDivide)8 _7 M; Q* h+ {8 b: H& @) F
- { c: }' J( {2 V* Y `. Q$ X
- this->timeDivide = timeDivide;! I: o1 v+ M2 b* x' R4 v. b
- }
/ M, x2 U% Y( d9 D7 q
2 v3 d$ ^+ t, h( h& B4 K1 v5 ~- /**
`! l0 y; {, U2 D - * @brief Get the fractional factor of the time the ymodem is called.$ E9 `( z2 O- S7 L9 R3 r6 ~ K
- * @param None.
7 \" E. t3 v; ?- N: t - * @return The fractional factor of the time the ymodem is called.
9 h/ H$ a: D _7 r3 X - */% G4 G0 z/ z: B1 S( U
- uint32_t Ymodem::getTimeDivide()
- `6 S" v) c2 e) t* d! z - {0 Y0 S |# P- M- q. v
- return timeDivide;
4 x6 u7 g/ }8 a/ v" c - }( t0 `- ~! Y- o
- 9 W- V# ^% b* y6 o/ n
- /**( Q0 c8 `& s g5 W3 K4 }! |; W
- * @brief Set the maximum time when calling the ymodem., D" B7 R% Y: |) {
- * @param [in] timeMax: The maximum time when calling the ymodem.+ A2 L" V4 M0 ]3 Y9 h1 C3 }- g
- * @return None.
8 }$ N4 r1 f7 {2 H8 b1 K# b% ? - */
' J* N% Z8 j& [8 Z1 D - void Ymodem::setTimeMax(uint32_t timeMax)4 h: L% ^- p# \6 p& d4 x- f
- {
7 P* G |: u+ U/ q7 m9 f - this->timeMax = timeMax;( O. Z9 ?& f5 P4 x& Z
- }/ K# C, H# S' l. ~) l! z7 c. }
- / R5 D7 L* X7 q" ^' ]
- /**
1 s: v# h% Z. ~4 M' a( i - * @brief Get the maximum time when calling the ymodem.
* x# S( M% K& \ - * @param None.
) S% A+ W) X j7 O% I - * @return The maximum time when calling the ymodem.
7 O, E4 |, M8 @+ ?0 M E7 i, q - *// A- j$ Q5 m, x+ z' ?) W
- uint32_t Ymodem::getTimeMax()
4 K3 U9 l7 _; K3 E) t% n - {' J% R- [7 I! b5 S
- return timeMax;- i4 `' l( f+ W$ C
- }
" ?6 w ]1 a p, J - 6 N/ z' l x T @& D1 ]
- /**, T. `" H ^. \# W* K9 n
- * @brief Set the maximum error count when calling the ymodem.
" o, v! F0 Y) q1 e7 T$ T - * @param [in] errorMax: The maximum error count when calling the ymodem.
$ r# W6 ~- a/ F7 m# B3 x - * @return None.
# v" P. F# | j- `$ J - */* i( ~$ q' Y: \0 t$ g4 {% m
- void Ymodem::setErrorMax(uint32_t errorMax)
6 U# Q9 D/ ]# h7 u' _" n7 G" s2 | - {
( v$ K) k9 [5 Z1 y - this->errorMax = errorMax;
% {1 J: x8 I3 I+ P3 H - }
- }$ N( P6 _* f: N2 p4 c
. q W* I$ O F) }- /**
; Q* Q s; m; \/ O$ X - * @brief Get the maximum error count when calling the ymodem.
: }3 Q6 O0 _2 N4 p3 d y: s) ~, Q - * @param None.% q4 h9 \5 V* m: y
- * @return The maximum error count when calling the ymodem.
B/ M \4 r! p/ { - */
" l* i# q7 \% p/ G4 d/ s6 n3 O+ a - uint32_t Ymodem::getErrorMax()
9 A. `+ P: I& h# V - {
# R$ K6 n3 y4 T8 S% K7 d/ A - return errorMax;0 b$ w. I! N3 k* ]& h
- }
' R0 U {0 L8 W) m - 2 R- n7 N& }# f
- /**7 o, x" S E- @% \( Q0 j3 N
- * @brief Ymodem receive.
" J* g0 P* n* O/ P$ w - * @param None.
( o! Z. V }/ _* L7 l9 y# F - * @return None.
o9 G1 o2 m7 l* ^7 Z6 o& y f! i - *// Y7 }2 _, D6 D% d7 R0 v# S
- void Ymodem::receive()/ _6 F/ O1 W, w0 M; [
- {& B4 ^4 {! C% @/ H; L0 u9 _
- switch(stage)4 \' O9 \; S3 r3 C" p0 h
- {
0 Z O4 v; K0 u8 a% o; { - case StageNone:8 W) S( U7 ~4 h* U1 t1 Q7 ]
- {! e8 V& m( b" q/ L% T$ t# [0 r
- receiveStageNone();
" }$ o: k( |+ q% E5 T( F8 ]8 o8 c
. }$ N; J- R/ S8 T- U. }! t+ u- break;
/ t# L& Y# G. Y& y7 }" p - }5 ~' P1 r6 Q2 O/ y. V% }
- : b. L" x1 M0 s+ G
- case StageEstablishing:7 l! T4 v7 O! V/ ]# R' i9 X; I
- {% @0 k* }- j3 `$ j/ b# F; C
- receiveStageEstablishing();: q1 E) r) D) ~- q5 O7 P6 G) e3 O
: J8 w: C2 _6 [ p4 Z( C6 \- break;
" [5 p1 n+ }* F" r - }' d! Z4 v# G% Z; b8 m1 X
- % A7 c3 `+ ~! k6 ]( Y
- case StageEstablished:. u# ]: {, V" {* M
- {
6 r2 W+ v, U! K$ Y# P; Q3 Q& P - receiveStageEstablished();
' {8 E% g0 j" f: V - 5 i! S. b/ g& I& }4 y1 j6 E- {( L
- break;: b) v. }- x6 U, H2 N" J- T# c
- }9 @1 e6 @. c q- A
- ' b X+ T+ U7 }4 a& a
- case StageTransmitting:
; J! f( Y* s8 F1 P; j7 c% g# J ] - {
7 M% m2 U1 n7 Z+ `0 @ - receiveStageTransmitting();3 p S1 q8 Y9 Q4 m3 U
3 b& b, b4 c& Z% P: u+ r2 m- S- break;
- q5 E' J4 T1 f! b - }3 f( ?- x0 F6 E' n1 }
" k3 c+ i! ]( O: ^3 h" q z0 a- case StageFinishing:- |, j1 O7 F) J9 R/ X' V
- {5 q% [1 v, @5 e5 x
- receiveStageFinishing();
. n2 v; m& s: a" y' H) x - ; [* J8 Y. x! F' p
- break;* Q6 B- F |' w7 y6 z
- }
5 g5 X- ]$ u' L4 j
* [$ B4 ?. m" @+ v1 [$ k- default:
( b9 `% X0 E1 A1 a - {! T) X- l% W& m# o$ s
- receiveStageFinished();/ O" n* A/ L% S
- }8 T: ~' H* ?$ L' S. ^
- }! w. v6 m7 {" ~: E+ _2 @3 Y
- }# i3 z9 }; g- [3 W. y0 E; [6 ~
- " W; B6 }0 }/ g% v }5 u
- /**
1 p( i; V; y* @% J8 h7 S - * @brief Ymodem transmit.
& U. D5 k) }' J6 r" j/ I - * @param None.
% Z9 Q7 R3 g6 Y3 |3 { P - * @return None.4 d5 _0 ^# V- k6 J, J; `
- */
+ I% U. c) K( @/ i! t0 p - void Ymodem::transmit()/ E8 K5 o" U- ^& h, F
- {& [! J( k" o% ^7 B$ w
- switch(stage), I4 [, n: L5 E% l: `% O1 c4 L
- {
" m. B S+ Z9 ~ - case StageNone:
8 H7 X1 n& u k( w! z. ~, Q" ] - {" j- V* O/ G g1 }& l: ]. l0 S
- transmitStageNone();) y, c8 a! V5 @- \, r. b
( @! q5 [- t9 H" P. c- break;
/ z1 h4 I% M; T. a' G - }! ?$ N6 [& f/ t4 p; W
- " i0 b" D7 D4 d0 z0 ?6 H
- case StageEstablishing:
3 Z' M5 s C& A# I: ^0 L0 a - {
% \( n' z2 s3 U' w% s0 l - transmitStageEstablishing();
. ]8 b* U- w, U/ _' | - , w* @' ^% l9 k6 ~$ c q: v* w
- break;. }9 s! N4 Z6 G, V. m
- }/ n, `) q2 w& I( V
1 b S, m0 E6 h0 O- case StageEstablished:
" O: q9 ~3 \4 n1 b- ?9 ?8 Y( ] - {
- a, | X7 b) \' k" L6 } - transmitStageEstablished();* | h% |/ W; W# G# m. W
# I6 I, @. x# s6 B- break;) W) |! n/ W( j: S) d6 }6 @
- }% W3 q' p- w* L1 ?
D9 s; s I1 r& l- case StageTransmitting:) ^0 S" ~6 d8 k2 m+ W1 L' ]
- {
% l& S; m* f) O8 w0 ], ^7 j - transmitStageTransmitting();
7 R1 q/ W, ~$ K* E - " c C1 ~& H! @# C
- break;5 e( f7 d) w* H
- }8 M3 V$ T" g! m a" e/ C# d
- " e" c% G9 _( D3 b7 y
- case StageFinishing:/ c# f, q6 u# P# q- P9 D$ U, ^; {
- {! I' m2 U" J, m2 B( E j
- transmitStageFinishing();
% J! A+ Y8 P6 C/ |7 J% c7 x
5 ~! s$ w: o# E1 \7 T- break;* e; [- I6 b* G9 P2 u3 F6 M0 ~
- }% X( q/ \. t8 @3 P
- / l* m4 z8 E/ j! V! Z4 d6 X! M' R
- default:
+ }9 ]# ]0 U# W0 O - {* q1 K* h& i4 E" G4 @4 R
- transmitStageFinished();8 C( |" w4 g# Z4 p
- }. z6 c0 A5 @7 j+ W2 o
- }- {8 k3 b6 y' g, a& G; v+ _
- }
* Y9 z* S% D- y: N' q( E, O5 k$ a
" v O, p5 b5 e" x( _, [7 s- /**
7 S4 X t# ]- ~! {0 `6 I - * @brief Ymodem abort.
: ~, S `- Y' n2 o& h9 l4 Q - * @param None.
2 o9 V" Z+ r; x r: _ - * @return None.
& [" U$ k; g$ d! g) j6 U7 A. L. g - */
4 ?' v* o1 F% f - void Ymodem::abort()" o6 w: @2 ~* T8 B# K+ U
- {+ x2 O$ ~5 Z5 ?3 s2 {
- timeCount = 0;
$ j q- b9 C1 C! t5 ^. L - errorCount = 0;
. A. T1 y2 l5 v2 \ - dataCount = 0;: O' |' J" H3 w4 d8 }
- code = CodeNone;
- W! C C8 g% `; _& u/ j6 ]/ [( n - stage = StageNone;
+ g% k( }1 h8 v- o- k: Z/ b8 Y* B
5 ^7 Q1 J3 J5 h8 I# i1 B0 C$ \- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
* Z8 }) F( [: c( d* C; O8 d4 Z - {
0 t; |, T0 ?% Z% [/ { - txBuffer[txLength] = CodeCan;6 D$ ^. K' A$ A p& W6 Y
- }! z* K2 f' B8 e5 _) F
0 b! S7 I9 `9 f5 E' ]$ V* W- write(txBuffer, txLength);4 u5 X, Q1 r9 I. l& z! g* c
- }! T! G1 Z6 `% J2 c6 w4 ~1 e. @
- 3 z P% G+ _3 |, k; k
- /**
: j q; a0 ]. ~% S+ U - * @brief Receives a packet of data.' {% }1 y5 ]# O4 Q# q% d9 D
- * @param None.
% E, S2 i* s d - * @return Packet type." R- z) _5 V" x8 X
- */8 I4 l: R- u/ v4 f9 }9 N' f/ {' T
- Ymodem::Code Ymodem::receivePacket()
! \9 {3 t: R. J - {) L( i+ v; k8 r' b
- if(code == CodeNone)3 c N- M6 j& A/ @4 L4 y$ p
- {3 s: A1 L" W4 ], R0 G2 p
- if(read(&(rxBuffer[0]), 1) > 0)$ U! ]3 S+ k q" a9 L
- {( N8 S+ Y+ n5 V3 ]0 V0 ?5 L
- if(rxBuffer[0] == CodeSoh)
7 r# j4 z7 ^4 h - {
5 G6 f6 G! h$ s( o0 ?9 w/ f8 F - uint32_t len = read(&(rxBuffer[1]), YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1);
7 Z/ S! D+ X6 Z! o9 K2 C: A0 s5 J - " D) g4 ~4 ~3 D) ?
- if(len < (YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1))# T, D0 a6 t# \, ~5 V
- {
. Z `6 u9 x2 Z) p( } - rxLength = len + 1;
( r4 N* H7 d2 f% A- @; j - code = CodeSoh;. A! n7 |' I9 p
% D& [0 A0 U0 Q- return CodeNone;
* Q$ O; {% Z5 Z9 N$ U# Y - }
! g/ C' i4 _5 c/ j- s( V. u - else
( P" B8 { _# y: Q - {
& F1 {3 `3 ]$ _3 X2 B9 m% S: ?" s$ e( W - return CodeSoh;
/ {9 `5 T, P" H' Y0 I - }, i+ g7 A9 X, `
- }/ M" z; V0 Y" z, p) f1 G
- else if(rxBuffer[0] == CodeStx)
6 I6 Y8 o$ F& w - {& D9 o2 x" c9 {! U* Y
- uint32_t len = read(&(rxBuffer[1]), YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - 1);6 F _4 `6 _ }% k$ t2 w
- ' e4 G6 ?+ t% J1 J; X+ P: |
- if(len < (YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - 1))' w0 \9 K( D0 R7 v+ z$ M! q% g
- { j# r7 v* F- y# h4 y% ^
- rxLength = len + 1;4 c5 Q; E! c6 }
- code = CodeStx;
/ I2 H8 C0 A n7 Q* V: b
5 I; w- C* f1 Z! Z) u/ e, a- return CodeNone;
/ s8 C) h7 N' V/ A - }
+ C1 S! c2 W4 A! }/ _- e& ] - else
( e. u; z3 r+ f9 z8 v - {
$ @/ H$ M/ O- p: W4 | - return CodeStx;; @# y! o6 o: y t& i
- }
! h F" L6 Y% w. D7 F4 G, K - }
/ S) `, B* t2 T. Z$ r. h- U3 _2 ? - else
, e, g: ^& p$ X0 t0 R6 c8 W3 } - {0 \6 w& s- f' Y$ V) }- m+ y
- return (Code)(rxBuffer[0]);$ D4 `$ z1 e8 b
- }
( r g- V4 f" q" [( q U( i" Z* \+ S - }
& n8 Q# E: q! k! M) r$ V/ [* K9 k) a - else6 d3 J" Q% V( `9 l# i; {9 K9 U) b
- {" K' b W6 b% T0 U9 r
- return CodeNone;, j, r. I6 e: t) O B0 p6 a
- }
% A5 p+ i1 y3 } - } R& u6 W0 ~2 \+ S0 I
- else8 R/ Y8 E9 F& ^. W/ \
- {
. g9 b0 L! ~. v. O" a3 U - if(code == CodeSoh)! F2 u5 J! D6 i6 S; w
- {' [2 q; m0 \' a5 `2 y- ~- I# m" a/ k
- uint32_t len = read(&(rxBuffer[rxLength]), YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - rxLength);
0 b9 ^7 z$ \4 x- E) g! u
+ Z0 b" W: W* H3 t- q9 E4 w. Z- if(len < (YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - rxLength))
) p2 X2 Q9 H& b3 W: h' K: n$ C - {6 t' A; N& \( p: g
- rxLength += len;
) W4 b' `& x0 G5 t8 B) I( S - 7 y8 p1 i% o9 m$ C
- return CodeNone;
: E' |( T8 f r" G) Y3 ]1 @# b* \: R - }1 G* N: G! S5 W" F# a
- else% X) f! V) O+ D
- {
+ c* s3 t3 Y6 E. p- R4 Y8 J' | - code = CodeNone;
; d; b5 e! J% ?
- B2 B) b9 V5 `6 E- return CodeSoh;
# I a" i7 ?, E; q! y& F- w J - }7 q; C% V( s. a+ r" J
- }% K- k- `! E; A. Y' d
- else if(code == CodeStx): P7 \4 H+ e* E) i. y" ^
- { h( P h' D2 d3 r& N4 N6 x
- uint32_t len = read(&(rxBuffer[rxLength]), YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - rxLength);
" s4 N/ O/ @( r - 0 A% {- w" x7 {) X
- if(len < (YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - rxLength))
: v% |& m- X# { - {1 h" z4 t3 R1 f+ a7 z
- rxLength += len;. a( u+ S) B2 M+ M2 [
- 0 U/ Q/ n( F) L* ?3 c Y8 @' B) o
- return CodeNone;: ~5 f/ t4 W9 n$ N0 q! t
- }
1 e! r/ e7 ]( C, j - else
' q8 `' ]5 \: H6 q# }! s( N - {& U3 ^$ S3 b' j2 o
- code = CodeNone;
; g8 `+ v9 m Z4 I& H
. F& N6 V2 W, L1 ^8 D- return CodeStx;
2 I$ h1 B( j& D, U+ _, p$ P+ ?% t - }
3 I) p8 S7 Z# K+ J - }
: D" y9 |2 K m( q3 r/ I- i - else
" s, G2 x! \. ^8 R- t - {0 U4 G1 G% Y! C# s3 ]0 o' ]- M0 Z
- code = CodeNone;; Q2 J& ]" E$ ]) T6 |) |9 j, p3 C9 t
- , m& n/ t) r2 w d& @
- return CodeNone;
1 _( g2 V/ s* s: v - }
: H, i5 a! a' Y - }8 d2 ~& }% E5 w- ^
- }
& I7 Y: W) d0 T# x; G, Z4 J+ c
5 o2 a/ z8 `4 j5 S- /**+ P+ w1 d" G, F( f. d w" G' B( Z7 \
- * @brief Receive none stage.& s+ M! b% f2 @ \- S
- * @param None.0 n/ x2 M1 e I9 y+ w3 q0 D( `
- * @return None.) J2 ? b8 H! I
- */ C7 m) y, p1 g' |4 B3 F
- void Ymodem::receiveStageNone()6 t0 b! C* P, l0 t k! X2 K
- {
& T) y/ U4 |+ \- T& i! c3 ` - timeCount = 0;
2 [3 h! G; ?9 i' ^# c( q - errorCount = 0;
0 U7 V4 r0 b" G U; M% u& r - dataCount = 0;
: Q$ F0 L% {& G. d1 v; n N3 s - code = CodeNone;
2 T5 e# ?. |2 [1 | - stage = StageEstablishing;
% D, x3 e- a. K8 T - txBuffer[0] = CodeC;8 p0 V4 O: f1 I3 ]
- txLength = 1;
6 ~% v+ [' [" E1 T; Q( | - write(txBuffer, txLength);( ?* D8 f! n/ c$ E3 N h
- }0 }/ ?/ _" H9 l, B
- 5 x& @ r1 v, I
- /**
: l+ O+ g0 _' K4 o8 z& E f - * @brief Receive establishing stage.
6 z r; U8 e( ~8 L6 u - * @param None.
6 n. d! }9 g4 ^8 J, ], h - * @return None.
8 k7 m. n6 P2 m7 m5 P" R - */
/ }0 A4 x# w$ k- M - void Ymodem::receiveStageEstablishing()
, W/ R9 R n) J' t2 m - {
9 A' h# Q1 A5 `) } - switch(receivePacket())
. k7 D4 s6 [$ f. s, e' E - {
& }* w' Y- C K- M+ _ - case CodeSoh:
7 \' B0 z0 w9 k+ ?" d - {: n) @1 G8 |; H. z+ i# I
- uint16_t crc = ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 2]) << 8) |
2 \1 w1 f8 \5 B! E8 J - ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1]) << 0);
4 ]% J# f! Y; I
, [0 G8 I9 ^$ A" t- if((rxBuffer[1] == 0x00) && (rxBuffer[2] == 0xFF) &&
a9 z. y1 V% c: m6 w - (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE)))* y d* L. x. d- T4 H+ f
- {
1 W+ r. W n+ s, `! j; x7 G - uint32_t dataLength = YMODEM_PACKET_SIZE;& E* ~- @4 g3 m: d$ j; y
- . ~% H7 `6 ~1 \6 A0 P: E; L! J6 k2 d
- if(callback(StatusEstablish, &(rxBuffer[YMODEM_PACKET_HEADER]), &dataLength) == CodeAck)
0 k. m. r! A7 d - { s- E, v9 T# [+ K6 H" }# o$ w
- timeCount = 0;
$ S! t7 y3 N' Q; W - errorCount = 0;5 R# U# x: N4 m. \5 I) g( o
- dataCount = 0;
, T0 Z0 g8 k2 ~9 U4 u. U) } - code = CodeNone;4 i+ V6 E. g8 \9 x) g9 ?+ O- n
- stage = StageEstablished;
1 V+ Y4 }; j5 ^6 f$ X1 p8 E - txBuffer[0] = CodeAck;( W/ N& `( h/ Q: m
- txBuffer[1] = CodeC;
# @2 s4 D9 w6 K8 P# C - txLength = 2;
4 ^# L4 f0 R9 j" v8 j - write(txBuffer, txLength);: v8 S: Y) O4 G/ ^! b8 t1 ?
- }
6 y/ `4 |: b8 n- Z9 h& U1 R1 l, s - else9 y2 B5 A' u4 y6 \3 p5 `5 L! h
- {
# {" V5 h0 \8 p3 ]& L$ @ - timeCount = 0;+ W" W$ y$ R }$ H
- errorCount = 0;) s. N2 O& H5 _
- dataCount = 0;9 K" k0 i U& w' H9 o1 _: ^
- code = CodeNone;. j; R5 S, P( w$ {/ |
- stage = StageNone;
" o: P3 G+ u: T0 E - 2 r+ M0 K% L5 p& Y8 k4 @# m K. @2 z
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)/ P- S; n- e b) K* R3 z
- {
, h! [0 U8 @" l - txBuffer[txLength] = CodeCan;0 Z( R. Q: G# }+ H$ e* K* r+ {
- }
) M/ d$ K! X( T( F- p - . Z% Z9 T$ i: e8 W! u' A9 G9 c
- write(txBuffer, txLength);
, O5 j+ H3 i& O! U S1 W+ ^ - }$ H6 E |1 H+ G3 k
- }; H G0 i7 i9 {
- else
# g2 ^5 {* f1 Z+ I/ y' U - {
/ V2 `; e% P, T; W9 _2 j - errorCount++;
+ w% f M& z3 A' x4 |) R
0 m; i& x2 h+ f$ ^$ E- if(errorCount > errorMax)
" i* }3 D8 b& k% w! c& V - {: ^# M% s6 p: V b
- timeCount = 0;% q* ]* `2 y/ c" C( g& i
- errorCount = 0;
! G1 I) k/ c! Z% ~4 H$ S2 b - dataCount = 0;
0 N3 r' [; z% y5 c - code = CodeNone;5 F2 L6 o5 t% y
- stage = StageNone;+ f6 F) I) t. l9 ]# b2 d
, [1 ~9 \( O) k$ k' l+ I- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)( J9 R; [/ x5 T+ u" ]. W* {0 q
- {: `3 [1 E1 ^ R# K4 x4 w& T8 O0 ^
- txBuffer[txLength] = CodeCan;
2 R: G: E2 ~. s* h - }4 [5 n5 i0 B- ]+ \: f$ k
- $ _2 M$ t9 V$ l5 |
- write(txBuffer, txLength);
& Z) r. `; O) O9 T - callback(StatusError, NULL, NULL);8 I5 O+ R3 u5 v1 }: E5 r
- }
+ r( l# H. q( w+ J+ U( L. {. t7 N( \ - else
* f, _6 S, k7 Q* Q8 R - {! U6 v4 M& @# V9 \+ l2 `* i
- txBuffer[0] = CodeC;) t8 h0 u& F4 L3 ^2 ^ z
- txLength = 1;
U/ X$ j3 G i7 e3 e - write(txBuffer, txLength);6 L8 Y1 ?7 ^% a3 \
- }
9 B' s/ U! F+ q' }. n - }
1 _/ v) e, E2 _7 T - ' i0 o9 p. e( W9 Y3 z
- break;9 m: Z# i1 n1 t; _+ b! v/ r# T
- }# a, v/ _. c. ~' o
- 9 u) O1 h d- O4 {3 r% B* I
- case CodeA1:6 M6 w$ N. C- D$ A3 D, j* H
- case CodeA2:
6 c+ Y' `; F6 I$ P - case CodeCan:
+ |6 u2 j% K7 F9 V) z8 w1 O8 n" H - {, P. M# {3 j, P
- timeCount = 0;2 d# Q) b2 P/ r3 R6 [- j6 q
- errorCount = 0;+ i) W! P8 @9 |, [0 }- ?5 I' d
- dataCount = 0;
+ D B8 l0 p7 ]% y% t ^3 X+ ? - code = CodeNone;
0 P! Z5 p# @- E0 Q4 U9 k - stage = StageNone;4 r) `' k- f, p% C) @
- callback(StatusAbort, NULL, NULL);, H$ m# l5 A6 s* ?" E- i
; V. B8 P! Q8 |% Q- break;# `3 z4 b7 Y, \- e
- }
; }+ B1 x$ G+ W% F; ? - 4 |4 z6 Q3 {/ x+ K
- default:/ a E8 Q# r. A$ V8 f
- {
8 O7 u7 A% H1 I% K8 Q - timeCount++;( t# d. {' M q% m
- . y6 v+ {4 |+ _& X/ M g
- if((timeCount / (timeDivide + 1)) > timeMax)
1 U7 F% S. ]1 u/ s% z0 x - {
9 ^$ T' G2 s8 c7 V; V6 C b% T - timeCount = 0;3 ]$ E" z2 L% c% |( ?% K& s
- errorCount = 0;# W( H( P) L% Y" \+ m
- dataCount = 0; H7 S0 ]' w3 H5 Y% r
- code = CodeNone;
1 G! @6 I# I0 E4 p% Y. R; I+ a - stage = StageNone;
g2 w5 p9 d' T X6 r& v& m# R; g
* m, A) E0 x$ T! ^ L8 `0 R2 k- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)6 A, w( F2 y4 ~( J% f
- {8 K* `1 ~1 w& V4 V" o
- txBuffer[txLength] = CodeCan;
( G" @/ K B! ` - }
5 D3 U4 c: z' `0 Y1 a' Q ~ R7 p - : w% H* k T' L+ _
- write(txBuffer, txLength);
$ G! y& E/ g, F- V$ I% i - callback(StatusTimeout, NULL, NULL);8 B$ i) H# t# T$ N* I6 l! y w
- }
; c6 C; s2 s) Z$ C - else if((timeCount % (timeDivide + 1)) == 0)
5 d1 R5 Q: ^0 o# i: K - {! P f: u' b; s" Z, s
- txBuffer[0] = CodeC;
9 h. h# b3 j7 x1 h7 z2 _: w5 c - txLength = 1;) b) g' E/ X. R6 E8 j6 i4 I
- write(txBuffer, txLength);
2 G. |& W4 x) M$ r# I* X% ^6 W5 @ - }
( v8 N8 N/ ]( o. s - }/ G/ I8 `8 ^1 [
- }& ?# n: r; q% |& i
- }
( F' ^" S! ?. k+ ~0 }
/ M+ T: y& U3 r- /**
% K! R3 _! S7 ^6 T1 w9 C/ P - * @brief Receive established stage.
* j4 k1 ~( U* X! P! d - * @param None.
8 s6 l* z! X2 ~4 g+ C2 L - * @return None.
9 {9 E; O n: ]7 K. q5 w6 n% i% _ - */5 k1 s& G; D- @
- void Ymodem::receiveStageEstablished()
. T+ W& w. E2 D1 d1 C8 T - {' l' ~' S" a7 n- s+ k5 h/ }' n) ?
- switch(receivePacket())
8 g' y+ z8 w( f- f2 f" h, @( E - {. C. q" [6 V* ?, i) h( j
- case CodeSoh:
& _+ z+ ^7 W) S! p0 b n - {0 q( j4 @+ M' x6 N
- uint16_t crc = ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 2]) << 8) |4 }( M. B0 _. f m' N- Y# D
- ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1]) << 0);
9 W2 r9 q7 Z8 D! |% R - * C2 L/ A3 y! g: ~+ ?9 v/ z
- if((rxBuffer[1] == 0x00) && (rxBuffer[2] == 0xFF) &&
6 B7 h& Y" x: J+ G: X/ T+ J- Q - (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE)))9 c6 H, J- o7 t
- {
) @( _8 Q7 G/ b4 A6 Q/ R; {7 @; Z" M - errorCount++;
! S; _/ c1 a/ X$ e3 N! u
* s- j6 s1 [- ~5 W& n7 E0 ~. C3 L! d- if(errorCount > errorMax)( s# A, u; q, n: I- U' Z
- {
( @+ L+ t$ {. @ - timeCount = 0;6 P7 V s0 l6 y' L8 j
- errorCount = 0;9 s3 V4 |% D% h
- dataCount = 0;$ @& D5 } b3 T" ^( N4 p( P
- code = CodeNone;6 p" e$ }+ k% {7 k
- stage = StageNone;
1 A* v# I9 l: C* Y N$ |/ J, j4 r - # [2 l$ ~' G# b! m, y% W
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)! ^) R0 V* {# R, U
- {
, W- t% p: K9 u1 g% o2 E s - txBuffer[txLength] = CodeCan;
. V7 L. c8 c" a0 F! `6 y - }
' i& O+ h7 s& ?6 O6 w
) Q/ n+ X1 g7 D/ j& s- write(txBuffer, txLength);
1 q6 a* x! y; C* h; k - callback(StatusError, NULL, NULL);; U6 W2 A7 q- U. t7 h7 N! |' i d
- }% z) |9 t: G C, G' i% I
- else) J4 b& X: S; r. ?/ _
- {! Z5 J* J8 D L, y- d+ `
- txBuffer[0] = CodeAck;
7 a! i9 K4 G5 a* H! t8 w7 i1 ]% Z - txBuffer[1] = CodeC; \7 N+ q3 v. d1 i8 E, ] g
- txLength = 2;
2 a8 F# f: ]* p" E+ V - write(txBuffer, txLength);! ?" x- s. `9 `+ J5 P! H
- }
6 T4 X* a2 H5 i - }
3 Q0 @7 e7 h( O9 N - else if((rxBuffer[1] == 0x01) && (rxBuffer[2] == 0xFE) &&5 g( n; p/ w; z- l* R
- (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE)))" P2 F. X4 h, _3 A! V6 p' m
- {, ~6 Q; X6 M3 g: q. t
- uint32_t dataLength = YMODEM_PACKET_SIZE;
6 e6 B; E/ L+ A A$ o' L - w) P3 e' l' O* T& ]
- if(callback(StatusTransmit, &(rxBuffer[YMODEM_PACKET_HEADER]), &dataLength) == CodeAck). c# e! `" d! ~- J( l1 p
- {
! m' J n& o8 S# @% a q4 s& p+ w5 S - timeCount = 0;
; [ d0 ~ J7 V; F( Q/ T, a( e J - errorCount = 0;
2 {& i, ]+ \1 C$ P3 x t: L5 g0 C - dataCount = 1;
0 D3 A, P* m& Z" | - code = CodeNone;% p( U+ R" H$ k3 u
- stage = StageTransmitting;5 Q& D9 c% z& f- a/ G5 B$ {2 W- ~
- txBuffer[0] = CodeAck;, r }! V8 h7 n7 ~& a4 } p
- txLength = 1;
; I+ B$ H y/ n V) i - write(txBuffer, txLength);" z5 H3 |$ d" D+ K7 |) ]" O
- }
3 |( f& s* d4 O! ` - else5 f# a8 Y/ X" D$ ^+ I
- {
! p7 M2 b% |$ l5 @' R7 C2 t - timeCount = 0;
" x, v' j8 J O' k- _5 O - errorCount = 0;0 \/ v {' k( @5 m) I% O: j
- dataCount = 0;6 ^5 B2 h: N4 ]% z$ M/ l
- code = CodeNone;
9 ]1 b+ l( O) @- p. \* t2 P4 H - stage = StageNone;# H' h( j% _2 k- i# H; l/ ?
0 i* }. ]. I( K7 q% c$ B- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
1 u7 R; Q( H9 ^" k4 J0 D& j - { i0 C. d! b4 {. S% u9 b2 W1 z' `
- txBuffer[txLength] = CodeCan;/ c' N' E, g/ ~
- }8 d; s8 P4 D* d1 i8 T
0 ^( h! z C: S+ O# E- write(txBuffer, txLength);1 O& D+ G6 B) k3 }) } C5 \
- }3 b0 y) [" M N4 D
- }
0 u: P) q" [3 h# D8 b* x, i - else
: Y6 C9 l; W3 {2 U a/ q/ C% T- y4 Q# | - {
g& Q' N! V' T9 }, e' k' m - errorCount++;9 ~$ g+ W. @/ L6 \9 {+ K) i, M
- $ H7 u! o6 Y! H) l4 H
- if(errorCount > errorMax)
, |) H/ q! u* W - {
7 `% x: ^# h1 ~$ K) |4 S2 { - timeCount = 0;7 `, l" e% K7 k
- errorCount = 0;; G" g8 a9 L- P; v1 d
- dataCount = 0;+ ~/ x0 b7 F& ^2 X# S
- code = CodeNone;
( _( z! k! H3 i) U6 H$ u8 U - stage = StageNone;
* x* n6 x, ^) X3 c5 g; K$ [* V
$ X1 e7 Z# L- ^7 y( o1 g) l- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)6 m1 C7 d( a7 A
- {
6 v: P" Y/ t+ F Y T3 f - txBuffer[txLength] = CodeCan;
: D) S6 I l. I' M5 s k* b' d - }+ b* g( S/ N/ r
- 3 z1 A( S; C+ M7 o/ l
- write(txBuffer, txLength);$ b) k. ?/ q, `9 E/ m# `( X: s
- callback(StatusError, NULL, NULL);
5 l& x8 E/ l5 d: V5 {7 ] B - }
/ ~% V" o* _$ C% q3 F - else
8 H7 Y! f. J4 A% c2 g4 \8 j. [) q - {7 Y8 D# }( q$ c8 i) t
- txBuffer[0] = CodeNak;0 I) N# t; k) s: x# g' G8 }& z8 z
- txLength = 1;
, V( q) c4 a/ P/ r% k$ Y - write(txBuffer, txLength);
& j! C. u& d/ r0 [' E0 ]1 G - }
! S( f' e1 f7 [* l( Y - }- R8 |4 }. A! ~2 p+ t
- 0 k: g* ?% I3 e5 S
- break;/ I4 s4 I# @2 s0 S6 d* r! [9 t
- }- }$ C. O1 U& l) r. `. o
- / _; L+ t3 D6 G+ n8 t# c, y, F
- case CodeStx:+ _. L( T! x( u6 U* P
- {
. ^8 I f' ]/ E2 A3 A4 G+ V - uint16_t crc = ((uint16_t)(rxBuffer[YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - 2]) << 8) |9 |8 J! B5 G( A) i' G! C" S
- ((uint16_t)(rxBuffer[YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - 1]) << 0);( Z( K8 ]$ ]' ^; p3 Z. U
2 g ~. l) q+ {; o% N- if((rxBuffer[1] == 0x01) && (rxBuffer[2] == 0xFE) &&
- [2 M1 _/ _. {8 l1 n - (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_1K_SIZE)))
Y( Q& \5 p) R3 T5 } - {
5 y. v) e( c1 m+ Q - uint32_t dataLength = YMODEM_PACKET_1K_SIZE;% Q' |2 r T! Z5 j3 q3 J
2 S1 a+ i5 z9 h( m5 Q% n- if(callback(StatusTransmit, &(rxBuffer[YMODEM_PACKET_HEADER]), &dataLength) == CodeAck)$ ]8 z8 {7 x+ Y6 }* A, ^
- {
7 g. h0 j5 t3 ~' Y1 O9 i3 z - timeCount = 0;
* _! Q, j6 Y0 }, p. Y9 a1 M$ [ _4 {7 x - errorCount = 0;+ Q$ P' F% o$ R
- dataCount = 1;
! O+ r u$ s0 o) C$ Z/ R2 Q - code = CodeNone;
7 d* L! a; H& M( v8 w; E k ` - stage = StageTransmitting;
4 [+ A; O4 I$ P: ` - txBuffer[0] = CodeAck;
9 M6 E. u7 J# A - txLength = 1;! u; g7 I4 M& e* A
- write(txBuffer, txLength);
4 N, C/ Y* U# Y0 r7 H7 _) S - }' p6 z/ Z7 v; i* T
- else, _1 O" E3 P, m6 y% T: W) t
- {
# A; m; o; |/ I9 r7 f5 A! G - timeCount = 0;
@; I# ^. u$ t# B6 ? - errorCount = 0;- B" M9 f9 X% X+ F5 h
- dataCount = 0;3 {! [5 [! H7 c/ b0 a& u2 Q6 R
- code = CodeNone;7 I6 A9 ~5 T' y( j. i/ v* l
- stage = StageNone;
: k H0 T5 a l1 q0 V; j7 x - 4 P+ c: W% V9 w5 `
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)' b0 e. ]/ Z+ S
- {
1 s5 i* ^- ]7 _# E k; e+ i5 \9 n - txBuffer[txLength] = CodeCan;
1 G" l, m! z8 E% K5 ^ - }* s: A# C1 x1 Y) t5 E' n6 D
9 P" W; n3 h5 }5 U. F- write(txBuffer, txLength);( O, e2 a+ }, N+ ]# {
- }
. s. F: Z7 V& ]- D" L' R9 O - }3 Z4 ^; x {" b' z
- else4 V" v b7 U" Z% W& \# e
- {: f! }( _7 l: Q( \& V( M5 W
- errorCount++;
. e# A% u1 x6 C' T/ A6 n w6 B9 H
+ v$ U% b6 P. s% C5 o- if(errorCount > errorMax)
' ?; o: u! U- F# u# M' y# B - {
0 o- T# G0 G2 h5 L - timeCount = 0;- x6 s( l3 K" {" M
- errorCount = 0;
- T1 i! Y7 |/ U; a+ O2 ]! ? - dataCount = 0;
2 g* W1 U K9 E8 t - code = CodeNone;
. k& W2 H( E! p# W - stage = StageNone;1 J/ H9 L* ]# I8 y1 |7 k; d8 \
- 3 i0 K( @4 L9 c7 o. Y0 r J U
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)" w1 L& S9 g: F2 ^ _/ t
- {
1 H8 F( u1 @& C3 s! b7 m - txBuffer[txLength] = CodeCan;! s3 t) w; k! S& z1 E! S
- } i5 H$ g6 G2 D7 C
- % R/ z; N5 ~) U$ |8 I
- write(txBuffer, txLength);
/ f$ O9 m5 C4 d- z( ]# B5 t: e - callback(StatusError, NULL, NULL);
) C9 M: w F3 i) L - }, b0 @2 U. I6 L4 h6 ~
- else
, S6 l1 A. b! J m0 S - {
& J$ G% c9 N- o. L" Y - txBuffer[0] = CodeNak;
6 B. I7 k+ T" o6 k: r { - txLength = 1;
& p* w1 B$ B; [* E2 ~) z% i - write(txBuffer, txLength);
7 }8 b1 b9 y% r1 g - }8 o/ V4 {5 X% k& @0 A6 k
- }& L% ?. z8 n! |& c6 w& G9 R
- 0 D3 i9 g* ~" ? e1 B# z. u3 G7 \
- break;" U9 m% E/ J! t5 q! t2 _# c0 d
- }
, Y( c5 z( g0 w# T - $ \4 ~+ @ y' x" _0 _+ U* Y! q
- case CodeEot:
/ c( P# N% G' X1 G" y2 m/ m - {2 X6 o8 b4 V0 K
- timeCount = 0;
) V- u6 e# V. v - errorCount = 0;* L2 ?/ Z" Z: F
- dataCount = 0;/ q8 d/ @2 [1 R1 S. U
- code = CodeNone;# u- l/ {: Y' o: h
- stage = StageFinishing;
# X4 V$ o* X) L; {# N - txBuffer[0] = CodeNak;. _9 f- n6 x e/ M
- txLength = 1;- c6 g* d3 ]: P1 S6 ]
- write(txBuffer, txLength);
3 S3 o/ }, k' j& e$ U2 D
) Q8 o2 q$ Z3 G8 E' e6 [4 f* e- break;. K& t; h C' t* k( j# i
- }0 ]8 O) r8 |' l6 i: R
$ N, U8 C% J3 K& E; s- case CodeA1:1 f" @# y" B/ W$ n1 Y- Q: y
- case CodeA2:
+ ~) G6 L- u/ v - case CodeCan:
) T1 E) L$ d `' h3 L - {. _- |+ C% Y. }( Z& \% W
- timeCount = 0;( i3 s# r% ]2 w+ R& q4 M
- errorCount = 0;" H3 O, z# ~. o, r$ M7 s0 B
- dataCount = 0;: r' G& e7 Z4 ?) N
- code = CodeNone;
# a% j: ~3 M) I2 Y& w - stage = StageNone;/ q9 `0 j, K/ W G7 M. z+ N8 Q
- callback(StatusAbort, NULL, NULL);( C" M. }: t' Q: K
- ! I. {8 G/ J; h: r! [! v$ ]& I
- break;
5 m& M# N; T$ I; ~- G' Q& C t - }
, d0 O L5 j4 n# v" Y8 ^7 k- r, J - & Y5 @ ~# g. s& j- |1 |% y
- default:
1 u# `! l! K( y, J8 J# M - {
+ b% O& w0 G& R - timeCount++;
% s& z8 q( h5 J" A8 A! E( k - 6 j1 o {9 Z8 x4 |' D' O B0 n7 d
- if((timeCount / (timeDivide + 1)) > timeMax)# u% W/ h+ U) E9 D
- {
8 J, `, j6 ?" X; Q( M2 I - timeCount = 0;
4 e6 W) S. ^3 d+ N: A2 N& |. y - errorCount = 0;7 W; {, x: c7 M- Q0 M2 y
- dataCount = 0;
" c4 \ I6 F& N, C - code = CodeNone;' e/ B- m" p# v: X5 M" [
- stage = StageNone;
: {8 C4 X0 f, Z( y8 i
$ F) }6 b* O: k3 q- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
2 z# ~/ @* [ ]+ a, v4 {% }9 g% R - {
. y. \) }7 R& i0 o - txBuffer[txLength] = CodeCan;/ I7 L* p. A, Q" n
- }
: R# ~: u2 R& k3 y
) V$ I* X. W4 \( C- write(txBuffer, txLength);
& Z! X4 k% |$ d - callback(StatusError, NULL, NULL);
. L+ {' x1 T- w - }; R( N4 b/ U; T! y A
- else if((timeCount % (timeDivide + 1)) == 0)5 Q3 ?9 K* ?: l) B1 X1 a# E
- {! J% n7 \) Y. I1 M* D5 ~- C. X
- txBuffer[0] = CodeNak;1 j) g$ n/ H3 D6 P4 v; N
- txLength = 1;
# Z& s0 b/ d- D, A* k2 K. u - write(txBuffer, txLength);
5 b5 y6 W7 x; }) _ - }
. j- t, ^, c- e7 x) ~% x8 O8 X - }
) R7 w5 O' r' _0 _' v9 Y - }# b$ c6 c. I+ p! ~6 p. ^
- }
" U7 Y- p+ y* G3 a3 m. A0 o
, V& u: b+ ~; W- /**6 O( T0 a. v# R2 O) O
- * @brief Receive transmitting stage.: W! l2 |/ d2 p& j8 h
- * @param None.5 m0 U( o6 [+ [3 m
- * @return None.
% e7 j% j* i+ {, x# ^! O - */4 x+ N5 {3 ^3 @ }
- void Ymodem::receiveStageTransmitting(); m! f3 F1 K7 A8 `& N# h
- {
) f: o4 P$ [# u3 X; ` - switch(receivePacket())
4 P6 [9 [* `$ S' R# T5 O - {
2 @9 S+ f0 l( `0 y6 H - case CodeSoh:, k+ b- R; z7 R7 m$ k* n- @
- {; A9 C) z/ o4 U9 J6 g4 C$ v
- uint16_t crc = ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 2]) << 8) |
; E& Z3 |( \- n6 q0 g - ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1]) << 0);6 R) A+ o5 a, \) b3 ^& H$ Q
/ v5 _; ]* f* t* R# X7 `- if((rxBuffer[1] == (uint8_t)(dataCount)) && (rxBuffer[2] == (uint8_t)(0xFF - dataCount)) &&. ~3 O4 {$ J5 ]- e6 g A
- (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE)))
. j. ?- m, a) n' c - {5 M+ N8 `+ l# [' N. t1 {# M
- errorCount++;
: N, l: X( v. e. V! @1 U, x" G
: r4 Q% v* @- P! H$ l9 o2 \- if(errorCount > errorMax)
7 O. g# H+ F" C$ L. ]; ? - {
+ s$ c; M) [- u- {0 C) j$ @3 { - timeCount = 0;
7 k! A: Z; u2 a% {+ v# p4 [. f - errorCount = 0;
& }; N3 @9 L; Q$ y/ z. |) q o! z - dataCount = 0;
# P2 {; _6 D! l7 ~- i8 l - code = CodeNone;
8 T, h- l- g% Y( Q! ` - stage = StageNone;# C4 g9 U; z% n. Y4 `/ H
* j: r- n8 N( O6 `4 @6 L* H% T- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)3 L' ^& I8 ]2 W* D
- {
- X# {$ @8 |% V8 ?) _: u - txBuffer[txLength] = CodeCan;
, @! R( S3 c: {6 J - }
: u$ f/ r6 A: D ] - 0 x6 X; z7 G8 `3 n
- write(txBuffer, txLength);. v/ r/ O9 o9 Q/ C" z
- callback(StatusError, NULL, NULL);( P3 g$ e0 Y+ v2 o! [) H6 k& Z
- }
+ c1 j, v6 z b( f! O9 g - else# g1 |! a" W' D5 S2 Z
- {* B2 D, k, J: g5 r' O
- txBuffer[0] = CodeAck;
% o, ^0 `/ Q3 |) L N - txLength = 1;2 s! b( k0 ~8 t0 M2 t% B
- write(txBuffer, txLength);
1 A' r2 N h( M3 A - }7 h2 H" Q" A- p( Y
- } L$ i, Q! r! D7 k
- else if((rxBuffer[1] == (uint8_t)(dataCount + 1)) && (rxBuffer[2] == (uint8_t)(0xFE - dataCount)) &&
* J) O; w1 C) K3 }) K, O D - (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE)))
5 Q3 K" X5 j7 E# \% g. E - {
9 w% E( W5 n8 W9 k6 s! \7 O( { - uint32_t dataLength = YMODEM_PACKET_SIZE;
& b4 U7 i# j* R1 q - & ]. N! a7 N* A( |8 ^
- if(callback(StatusTransmit, &(rxBuffer[YMODEM_PACKET_HEADER]), &dataLength) == CodeAck)
1 H! g, O G! Y) j& h - {
+ l+ I+ N; d; Y& w: s: Y1 r" x - timeCount = 0;
! A2 L K4 U+ ~" s' b8 z% G4 m, h - errorCount = 0;
8 ~* f& j5 H$ E& _3 m5 _3 P - dataCount = dataCount + 1; B! c( {* Q0 F% m# y4 w" X8 I
- code = CodeNone;& L0 z4 Q* b, A" O, I
- stage = StageTransmitting;
( b+ h( ]2 [! y: [) ^. R* Q! A - txBuffer[0] = CodeAck;; J" V, E' V! ?9 W
- txLength = 1;& B6 d: ~7 i/ Q* u. p
- write(txBuffer, txLength);# K. l! T. i0 S/ ]! \
- }
) l! Y# g0 A* Y - else k4 ~0 @( h" Y8 X- D
- {
/ u4 r5 ]/ A- V% x! X. I3 R3 U/ O - timeCount = 0; v+ I3 h) q+ t
- errorCount = 0;
: v1 z$ [9 l# X0 s7 d - dataCount = 0;
0 ~* g5 X& D' [; P - code = CodeNone;
& z7 ~$ y% w% [& X6 i+ h. M. V - stage = StageNone;7 i, K4 j- E# j: p, F. P! u
9 ?' i# A( x4 E7 k- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++); ]/ y8 l. J/ o$ z
- {- T7 n6 c0 X7 U6 |! a9 D
- txBuffer[txLength] = CodeCan;
! J' S, D* z( Z- E& b: c - }+ L8 }' @6 P3 T# W6 y# z
$ B$ ?5 I5 [, O9 g7 Q- write(txBuffer, txLength);
) L4 D8 q V: Q0 B# }8 ? - }6 U+ N+ z. i" i+ H$ {
- }
" Z8 u6 y1 j( o% m0 k - else
7 |9 j/ G5 H4 o6 C$ b3 O( }% f - {& p$ ~8 n) ^2 P0 h5 e, O
- errorCount++;3 C" G- E7 ~ o6 H
- % B! \9 M+ E7 B# X
- if(errorCount > errorMax)
- \# g+ [+ R6 n6 } i0 J - {4 S' \$ A4 F' c7 Q K) p
- timeCount = 0;
& m$ T3 A( E# N* @8 v% b3 e6 g - errorCount = 0;- q% [/ P4 ^3 V& t% L. O
- dataCount = 0;) I: n, a+ b9 o6 A- v
- code = CodeNone;3 L9 e0 f% s" k# m+ v
- stage = StageNone;
4 z: j9 s5 d+ V2 \' O# ^
$ r0 R+ |0 X |- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)( u3 A" J% A+ U6 @
- {
1 D' g! [, ^: k( d4 V7 r% r$ i, F - txBuffer[txLength] = CodeCan;
; m* ]+ g7 ]4 j3 }8 _6 k - }6 b* D, @, {7 F" e T$ m
- 8 \! X9 f9 G; n5 c
- write(txBuffer, txLength);- H# f' U% H8 @& F- R
- callback(StatusError, NULL, NULL);
0 k, p: O5 P z+ T0 x$ H; ]" c6 [4 R - }
* A8 r2 n- A. q: P - else
f* _5 y! V+ w8 U7 n$ v r$ b5 E - {4 }0 p( A* M7 N( \
- txBuffer[0] = CodeNak;
# F& z0 V4 s2 o( N5 i2 |9 V. \ N. D - txLength = 1;" x+ t. O3 T7 ^
- write(txBuffer, txLength);
5 w1 A8 y# n' F) u, Y - }5 U( Z9 K/ Y: E! j) _
- }/ Z( d/ h! i; H! }( l$ E1 Z
- 1 j* }$ V) T9 ^
- break;
: B7 M2 D: E0 H- N - }
) n. ]" p4 f c0 O8 E4 ~2 ` - / q0 s) h* j) \1 {: C2 Q) o
- case CodeStx:3 c. [' O7 R1 O5 y( D& U
- {
7 `# z& G/ J8 x: q' j; D - uint16_t crc = ((uint16_t)(rxBuffer[YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - 2]) << 8) |
) M6 H$ i. a# A# F - ((uint16_t)(rxBuffer[YMODEM_PACKET_1K_SIZE + YMODEM_PACKET_OVERHEAD - 1]) << 0);
. d& ~( v+ p4 I) o - 8 C. H6 H: t- m" p. i8 e
- if((rxBuffer[1] == (uint8_t)(dataCount)) && (rxBuffer[2] == (uint8_t)(0xFF - dataCount)) &&( X* \" G. @8 e/ J; y; h% C" p
- (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_1K_SIZE)))/ G% q' }) }6 [6 R
- {% j7 j! H2 \* n+ X; v" ]7 C
- errorCount++;
2 I. w: Y7 f" F) c1 G+ T4 `- O9 \ - % a3 k7 q4 O, g+ ?
- if(errorCount > errorMax)
& @9 E8 n! y: T2 r q* j - {
8 n5 b/ w5 M) D. O - timeCount = 0;
! M3 _( y# P# S, U! m$ L - errorCount = 0;1 N0 \. k2 ~1 b) @
- dataCount = 0;
4 p( Z- c6 g- v' ^' W$ q - code = CodeNone;
; H: A/ K& I3 _- J; q% h: n6 l1 O - stage = StageNone;
$ t% y C3 x1 O1 _ i
9 l1 X2 n" L% K- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++): u Q3 @3 l0 {( z7 a \0 }" k
- {
5 P6 ~1 J/ l0 c6 n0 ^ - txBuffer[txLength] = CodeCan;) }2 w. y1 V' d' \+ L. U7 M/ z
- }
* S2 v* x! A8 ^/ ^& o8 t$ f6 j( C - & m8 L; _) _$ r6 R' R6 \
- write(txBuffer, txLength);5 z8 {" O6 T, l% G8 B
- callback(StatusError, NULL, NULL);. X) h# }' S8 D
- }, M$ q& H3 R" n W1 _( r4 G
- else) d8 z( x+ W/ F) C
- {
( o% R- f6 Y, W: Z) m, i - txBuffer[0] = CodeAck;1 {) \- f9 U0 ]
- txLength = 1; J1 d- h9 Z& x
- write(txBuffer, txLength);0 `, A$ W2 F* x* W Y9 R
- }0 D" V2 b( s+ Q; A. ~% G
- }
) O& x% n( w# ` - else if((rxBuffer[1] == (uint8_t)(dataCount + 1)) && (rxBuffer[2] == (uint8_t)(0xFE - dataCount)) &&& |) ]$ h% u: K5 }# t
- (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_1K_SIZE)))
2 k/ X* c* u, t! e9 R8 g, w - {1 M& M, N3 A# @( I3 X1 e& v
- uint32_t dataLength = YMODEM_PACKET_1K_SIZE;9 M& V3 \* L# r/ Y9 s" r" \) \
- ; h$ I! a) ]1 v& x! q
- if(callback(StatusTransmit, &(rxBuffer[YMODEM_PACKET_HEADER]), &dataLength) == CodeAck)" l* |* U8 @2 g C& }5 h$ _" U6 z
- {) t: A) b8 o# y# B) p$ ^
- timeCount = 0;
. q3 G N5 Q0 Q( {) j. X+ q - errorCount = 0;
' q$ B- R' {/ W3 O2 o$ k- } - dataCount = dataCount + 1;, z. b% W9 e3 M& w0 A! ^
- code = CodeNone;& k, X' M$ @% j: N# S* r9 u
- stage = StageTransmitting;
6 q% Z5 @# w+ k/ Q ~9 W- g - txBuffer[0] = CodeAck;
& o) J+ P2 F( u - txLength = 1;. y8 p/ W' V: O- [
- write(txBuffer, txLength);
/ o1 B0 j# M7 f9 ]: A# ] - }
" B; [9 g3 I1 X0 w# J - else9 t% ^$ l: y& e8 N' C1 T; u
- {
5 H, A) Z2 h; c$ ?4 @. O - timeCount = 0;
' M4 ^. O1 h/ m( I5 L* S - errorCount = 0;4 L. t, f" `0 v2 [! G
- dataCount = 0;) T8 g( h5 z9 |% `
- code = CodeNone;7 v1 ^* y, ]/ P- p. a+ t
- stage = StageNone;8 b8 r5 s( k& P1 ]& |& F, |! ^# Y* m" \/ b O
- 0 @+ H8 u r/ i; K- B) e) u& P
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)+ C U) z0 h6 T8 x4 W6 J
- {3 E& C% E# g, P" B3 [
- txBuffer[txLength] = CodeCan;7 p3 U; }# w: a/ e/ m1 ?. D
- }5 d* z+ T/ j3 t
% G# p7 R2 L3 C2 }6 ]& o- I/ A8 \4 w- write(txBuffer, txLength);% {1 X' H, J) v: v$ `
- }
# t& Q3 A" w) r2 s" \! @$ }8 O/ ` - }
2 q7 U5 O4 Y# m9 e - else9 H5 P- P$ B Y F; J
- {
" k7 P) T- W. p( U/ T - errorCount++;
& [1 _4 G# O, b, }. q - 4 B4 |2 b# b9 j) R! o5 ? e
- if(errorCount > errorMax)
+ x! n/ b: q7 [4 x/ r- [ - {
& o" P, ~' K! k2 H- K0 Z6 F - timeCount = 0;. k% ^6 T" w* |% t9 O" i% h
- errorCount = 0;# g! Q/ Z y$ ~: C, s9 N% T
- dataCount = 0;
& O9 f& T* a8 v - code = CodeNone;
. e+ j7 r- a" ~5 d- h, m( _ - stage = StageNone;$ s. |( S- ]8 b+ N
- # g1 z( N# x% h J
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)1 p, d* e9 u$ m
- {
4 v: C9 \4 j- U8 d - txBuffer[txLength] = CodeCan;
+ K' ]) X* L& H - }
" R% s5 o! s" X - 1 s2 a; ^4 H! }5 m" }2 w
- write(txBuffer, txLength);
, t3 a$ H' p0 a. n' G& R1 W/ ^ - callback(StatusError, NULL, NULL);
& D/ I: n- a9 L2 ?5 k! N9 w - }9 w. @+ P# n; Y1 w( K! E4 v6 Q7 f' k
- else* r1 M' X; ^# M2 h6 ~' c5 `( h
- {
0 D) Z/ e1 L, s {' i8 Y4 T9 r0 ] - txBuffer[0] = CodeNak;
/ P( \5 N- V4 t) O' k - txLength = 1;* u' h7 i) h" P6 k5 l$ k: A
- write(txBuffer, txLength);: B8 _- T W, g
- }
( ^# U! h$ c3 u- h- F; D ?2 _ - }
: r8 j+ `3 p& m) |/ [. J7 y. U - s4 i+ p- m* u3 j+ `+ ]
- break;
: z+ d, Z9 r0 m. C( x- X: n7 _ - }
; _% O) r6 W4 U$ M' e+ x6 c
/ D( ]2 u* T3 H, Q& ?, w/ m- case CodeEot:
. F# t; `! d2 G8 {6 r) ^ - {
% ?; y! F, U+ s7 n$ Y" l8 k - timeCount = 0;
+ Q# H0 c" k/ R4 S1 G6 J! C% |* { - errorCount = 0;
* @9 v7 Z, n9 z) A1 V - dataCount = 0;
; D& L! k+ M" M, m# M# o - code = CodeNone;7 u! t3 X( k0 k g
- stage = StageFinishing;" f! X$ e1 g- j, x1 F& e2 e6 O
- txBuffer[0] = CodeNak;1 N! `/ V& O m1 x; m/ b% i; g
- txLength = 1;
; Q/ `8 m4 N- V! r& f( c' K - write(txBuffer, txLength); }$ }" ?2 _7 s K# Y
" @3 q7 m4 m: G5 O0 s/ _2 ]- break;! Q) t3 @5 { Q7 b' J9 I7 D ~" l
- }
) c- j" |0 D/ y2 o2 o( H - 6 v; J& g. m6 A5 n$ Q7 i+ d& C
- case CodeA1:
) v0 |" e" V {8 C- v - case CodeA2:; Z2 Z+ `) B0 q, p* N
- case CodeCan:
& l* `2 P: J8 u - {3 t# h3 i" T8 V+ z7 Q
- timeCount = 0;, N1 \0 ]* Y$ P, J% h: h
- errorCount = 0;$ j! A2 T. u( i1 q5 g
- dataCount = 0;2 |; d2 J+ a4 {( a' Y, Z9 o! n5 m, m
- code = CodeNone;
4 G* D- G1 [- |- m/ T - stage = StageNone;
. I. R% k, J k$ s0 a - callback(StatusAbort, NULL, NULL);
3 ^0 _0 M: B/ _& \3 o
3 Q5 m8 }9 j* b, L- break;
& T2 v5 t7 L0 G- s3 k7 P# _, r - }5 l0 F9 c" n; i% n
- . ^8 p8 O4 X/ L8 M
- default:0 L. {8 @9 l9 B& i6 C
- {* ~& f2 e ?( L* W8 W
- timeCount++;
, ^- z( d2 G9 Y* x0 }/ G, l
2 r. L& }; X7 T- H$ l- if((timeCount / (timeDivide + 1)) > timeMax)% i! P% ~% ^: e' G
- {
3 P# \/ b# p% Y& N( z, \; ?7 ] - timeCount = 0;
+ q& k- ~ U) _7 w- ?* ^ - errorCount = 0;+ d7 c* B0 p' X9 J# G
- dataCount = 0;
2 y& }* j- `/ \2 X- X, P - code = CodeNone;
8 S2 _8 X+ A+ H/ Q& L - stage = StageNone;
4 i. H8 @4 a" _/ H [& R - ( g6 Z% q+ ^9 s* A8 `0 D8 j
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)+ m4 G+ _8 A# l1 z
- {( s- s! \7 }1 l4 L/ p, D
- txBuffer[txLength] = CodeCan;5 |% a' Z4 b5 B3 B/ m+ M! F
- }$ G$ x# m0 V! K7 v
# E' u! n7 T' b' ` E- s- write(txBuffer, txLength);, V$ p9 l4 T- v1 k+ t9 w
- callback(StatusError, NULL, NULL);! l- d8 Z0 D" T# |8 C+ e' H
- }' W7 y0 t" C5 O1 E% ^5 m
- else if((timeCount % (timeDivide + 1)) == 0)4 r* N3 E" F6 D; O' D+ P5 y* R
- {5 H- C k9 p4 e
- txBuffer[0] = CodeNak;
, e: s9 ]& Z( ~4 o& g - txLength = 1;
: P. D" a; C U/ k; I6 P4 m - write(txBuffer, txLength);8 U" m" ^3 j8 f4 S. R! N) f
- }
4 `( N4 F$ K5 a; _) l1 r - }/ j6 t. S( p5 t% ~9 t0 b* o- K
- }* M9 Z! M5 v5 d6 a; S' q
- }
- F, G/ h( L2 b- R6 F' m% M( r
0 `+ X# G8 `4 \2 d" P- /**
9 c) R, Q) W8 [1 z/ j3 b% R - * @brief Receive finishing stage.
$ h" k8 I2 I$ b6 [ - * @param None.* U7 t9 n: w: [( N& M
- * @return None.* ^1 t, d0 f1 u% e% y# |' j
- */
4 h) D! i$ F* y( ^! F9 M. \: s G7 D0 Q - void Ymodem::receiveStageFinishing()
7 g( s" Y& \/ m8 f" ]0 b* n - {
+ k+ k* I& x" |3 t5 j2 J - switch(receivePacket())
1 w. t% }/ s- Y" j& O& Q3 v8 i1 U - {; S; |! `3 P( F; z* r. E7 g0 m
- case CodeEot:
5 V8 K4 Q& K0 N+ ]2 ] - {+ o W8 G9 o b! s
- timeCount = 0;
8 Q' Y( L- g H, W- a - errorCount = 0;
/ i; M& Y. J( B' p - dataCount = 0;
( Z! l% L+ }' E2 Y - code = CodeNone;
! b8 b. k& w" j8 C - stage = StageFinished;. l# h6 r* a2 t$ d( m
- txBuffer[0] = CodeAck;
. T3 S( b3 P( h5 D6 R' K - txBuffer[1] = CodeC;
2 X; |7 }8 K* d! I - txLength = 2;
: i" z( y$ i2 n! Z6 b - write(txBuffer, txLength);
7 v6 p, p* `8 n: x* K
4 Q! U, z- W, B# {+ m5 a2 L* }4 }, o- break;3 b0 @* h. b0 w% G3 |; y
- }
/ z5 d0 O% p: C6 \8 g/ O - 1 ~% i, H" u0 `3 M; U
- case CodeA1:
5 H! `' M+ l8 R - case CodeA2:; O& E& r# b. s3 c" \1 f( a1 O
- case CodeCan:& r' ]0 [2 X0 Z) w" Y. ]' p" D
- {$ Q! u+ `: t3 a. Q
- timeCount = 0;
5 n/ g$ w: n8 z, {; C- d - errorCount = 0;. D l0 P3 p+ u! [
- dataCount = 0;+ V: G# v# R6 m. ^" p
- code = CodeNone;
/ r% U) [$ v; q" b! Y - stage = StageNone;: }- y; ~; @" h) D% K/ B$ v
- callback(StatusAbort, NULL, NULL);
0 P( y4 t, I/ K - - u/ Q! {: J8 C+ X" x1 c/ `
- break;
! O) }. o& G; O+ d9 M+ J - }
$ j6 D. `! y0 n# z6 r; w; s
$ j: K6 d' R6 V7 m g1 H- default:3 X7 {7 _0 e+ h
- {
) |* W/ W% [/ x3 Z3 k' `! w3 h - timeCount++;
3 g6 x# E6 p+ `4 M; P
8 l, ?2 c4 k& \0 S. Q! o O- if((timeCount / (timeDivide + 1)) > timeMax)4 {1 t" h" Q9 b! B
- {$ N8 J( L. m% @7 s. Z9 n( Z
- timeCount = 0;
3 }0 j$ c/ b$ {0 [. Q - errorCount = 0;
# i) E) o# k2 \9 i- h4 t; n - dataCount = 0;
* B' _$ |" z& I - code = CodeNone;
% Y9 k5 \1 v% Z( J# @- Z8 E - stage = StageNone;
9 A3 h9 S% _3 c0 o, h
* k- z" M1 { s- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)* k+ |; Z- }' |+ T( h" {; X8 Y0 L/ y
- {/ g D/ \( i+ t- {
- txBuffer[txLength] = CodeCan;- S$ j* o/ Q, c$ e) |4 t
- }' X5 ~0 T9 \; N; L- Y
- 0 q1 O5 y; X: n$ A& |8 G
- write(txBuffer, txLength);/ {4 s' V8 q3 ^6 j) ^
- callback(StatusError, NULL, NULL);9 o, N. ^" @6 y! |3 @ o
- }4 F! [! M2 ?; k# Z5 y
- else if((timeCount % (timeDivide + 1)) == 0)# U# M5 A; K/ i! p3 D; F
- {
% }6 u* s* Y9 D! t - txBuffer[0] = CodeNak;* N* I8 i# o$ u& U
- txLength = 1;
& V% _# w6 [/ s2 }' o9 X; \ - write(txBuffer, txLength);
4 v6 s3 A& A/ s9 t- p8 f8 Q - }
3 e. ^2 z1 F/ O - }
+ w6 G% C9 R1 a" k* _% L - }
: M; M: d$ E T' q - }
/ G, R0 U0 O, \; d+ z# k, W! [
; h* N/ X; \1 |1 _. F' k- F- /**
p4 ]* _$ r2 L, Z - * @brief Receive finished stage.' t( C5 I$ R* C9 N
- * @param None.0 c8 E+ o- I! x, i' _! h
- * @return None.
}# b" ~. [% P - */! w( \4 [+ |! Y7 b! p
- void Ymodem::receiveStageFinished()
8 Z) M5 e) l- H - {. y. e. M9 x3 [( S
- switch(receivePacket()): F! E4 G) ]+ B6 P0 z d
- {1 D( N/ t, H2 o, L
- case CodeSoh:# N- p. T7 |: r
- {! O3 ^4 g- l) Y [# f
- uint16_t crc = ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 2]) << 8) |
6 ~5 W2 Z6 N' |# N# w, A. _/ c - ((uint16_t)(rxBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1]) << 0);4 o! i8 z' N! H1 ]. x
/ Y3 o7 n% W$ Q, j* T0 i- if((rxBuffer[1] == 0x00) && (rxBuffer[2] == 0xFF) &&
0 }5 _# _1 y$ W$ i0 D) t - (crc == crc16(&(rxBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE)))& N4 F0 g4 X1 ?, ? U( a% ?# ~- I0 ^
- {
8 Q) @, ~' b+ G! R3 V - timeCount = 0;- Q( g9 R6 }1 t7 M0 j7 C8 w2 H
- errorCount = 0;
8 N& C* l3 B0 C - dataCount = 0;
& N! g' C @4 g6 }* G - code = CodeNone;
% [3 y. f' `4 U' M3 S' m - stage = StageNone;
9 K& z) r z; j" }9 W - txBuffer[0] = CodeAck;
; R0 ^* S4 {4 x! V" p5 z( H8 U - txLength = 1;
. z9 k: p, Y0 H; G2 v - write(txBuffer, txLength);( o- b1 B- E' J- z* H) l3 i, u1 f
- callback(StatusFinish, NULL, NULL);
' B' B' m: T( l) M1 \0 P - }
) T( u1 {# |' u8 x - else1 z2 i, h0 i9 j- x1 i' u5 a
- {0 a J& A4 O0 A5 t R4 e b) A
- errorCount++;
2 A4 i# p2 g4 ?8 T- |* y - 8 ^; D6 a* |0 _& W3 C- K! r
- if(errorCount > errorMax)
_+ F! J0 Y6 p2 T& r - {* ?# N3 L( v* q* f0 O/ y
- timeCount = 0;* x9 X1 v" [3 U4 W8 s
- errorCount = 0;( I) f3 U+ S6 _- q! @
- dataCount = 0;3 D0 \) ?6 R8 p o
- code = CodeNone;
& g% |2 h0 X% _# G! I4 h - stage = StageNone;
) t: t! j& A3 h7 Y - 5 Z3 d- i1 }/ t6 A4 M
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)/ A3 w6 f2 t- F3 y
- {' o: k5 a* B4 H2 m, F
- txBuffer[txLength] = CodeCan;! P8 H6 j* z, T$ @5 W
- }
' C. G6 J2 g1 Z6 }% h$ c. Z - ( S. e2 S) B1 n% K$ p. R
- write(txBuffer, txLength);. f/ C9 v8 {1 z! ?0 v1 [, j9 Z
- callback(StatusError, NULL, NULL);
6 ?5 ]( k, C5 Q7 n - }
$ v" D8 O) z5 I( X6 S2 e4 E - else
t- U' k b* ?- l( \7 d - {- s+ r, a3 d+ U" l
- txBuffer[0] = CodeNak;2 Y; f; P: z0 i: d
- txLength = 1;
) d# V3 _. E1 F - write(txBuffer, txLength);
( R# v0 p( `4 O# [ - }, b0 |: M' g/ {9 B4 [
- }
: Y1 [6 }) g- j - 7 h" o" _! j/ V
- break;3 b. k& R( F6 W7 [2 H7 {
- }
& r9 Z. N- d- O z3 \& ?
) w: {6 q: v' M, f L- case CodeEot:4 ~; c D9 h3 {* t% s
- {$ n* `* G) p- J' g: g
- errorCount++;8 a0 N' {1 Y# T
8 d/ k: l, W5 k9 e+ z, Z/ Y a6 U- if(errorCount > errorMax)0 b; s0 j0 I9 x; K% }$ O, l! \. d
- {
* F. n2 V- e6 d3 S - timeCount = 0;
3 a7 u9 ~0 z) Y+ a- P) g - errorCount = 0;
" k! @$ y( j; e7 _- A! E: ?7 B9 \! P/ C - dataCount = 0;
! a8 g. u5 j3 Y0 [ [" s* A* V - code = CodeNone;
5 o$ D# a& V5 i. P7 t - stage = StageNone;) f* j3 ^' u$ b" {' L
; Q4 G$ M0 z* F4 e# `- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)+ o& ^8 ~6 J: r4 _4 f
- {
8 V/ Z# l7 G0 \4 v# t2 L- R6 [/ F - txBuffer[txLength] = CodeCan;: l: F( r) [9 L+ M. |" ^0 R G: k
- }
. P' Q0 k$ r5 S
0 U: ~: `0 g- q: R0 |- f. Q- write(txBuffer, txLength);! f& R# I4 h, f8 t1 x
- callback(StatusError, NULL, NULL);
' M ?7 \9 K# J- K - }& b$ s5 ^1 Z3 N: f8 H1 `( l
- else ^. y0 D; \& l' b% K6 K
- { Z8 s1 T* S- h6 V8 O( r
- txBuffer[0] = CodeAck;- f) C1 ^- |# Z5 m" F" O) ]
- txBuffer[1] = CodeC;. b3 V& W. Q$ o( R: C6 S Q* m
- txLength = 2;7 G7 v7 L, ^% Y
- write(txBuffer, txLength);
- G4 q3 b* U! c9 v7 e: H - }9 T* s* v! p, H
* j) I# D( T' }3 n9 J, B- break;2 q+ c2 W: }- w& l% Q; d/ T4 ?
- }: Y. W" j, ~. c4 o# Z9 g. l2 ^
& n# Z+ I* _; S7 ~8 ]) {. Z8 J- case CodeA1:6 N* x- M- r0 y, i: v' ]
- case CodeA2:0 R% o+ ^" k5 n. @* d2 `: j) }- m0 U
- case CodeCan:& Z& V& w( y1 D* E$ O6 l
- {
* | r" {, v* [: D - timeCount = 0;
6 r/ q# x! i0 K7 C, I) x. d - errorCount = 0; {4 I0 `3 f% J7 Y$ F3 S
- dataCount = 0;
7 J7 s2 Q3 W3 z4 J% \, s - code = CodeNone;/ M0 c4 _' c5 F( X
- stage = StageNone;
$ P! s' |3 c% u6 I0 {( N - callback(StatusAbort, NULL, NULL);
# q" _+ V7 m) g3 a& L - ; j/ _ D7 l `! M, j! t8 ~
- break;
0 ]* J" V! t+ g8 u9 d9 m2 ^5 @ - }
9 U E4 ?2 K% O
8 y- Z( c. g. F$ p9 T/ e- default:
8 ~1 z2 A2 s' Q7 D - {
) Z: {. A x$ h7 L - timeCount++;% u/ Y% N5 A0 T6 M, o, J
/ J, t( k9 e& ~* V4 v/ W5 m6 M2 ~- if((timeCount / (timeDivide + 1)) > timeMax)
4 o( @8 L) \6 k, T2 E3 A - {
, G+ \7 H2 E _ - timeCount = 0;
: E8 a' Y7 @/ [4 u- I6 b9 W1 H - errorCount = 0;
* f/ e& l, E8 R1 k" Q0 V, W5 P - dataCount = 0;' _8 f t7 F+ n j: L+ S$ \
- code = CodeNone;
9 H4 q' z0 P- @& H: T& T) C - stage = StageNone;
# y' }; D% K: S6 ]; M. X- b
; Z. Q9 v$ F; U- [* j1 S6 ]- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)8 r% |) m- Z& q& O+ j
- {) Z0 S+ {8 g0 i, |1 r* h3 Y
- txBuffer[txLength] = CodeCan;
; q. \7 {& w; n5 q - }% ?8 |) j6 O |1 F9 K; y
- - s% u" B& o: B; y# E x$ c
- write(txBuffer, txLength);
, O' `) D( S* m6 M2 M% C9 c - callback(StatusError, NULL, NULL);* A8 W0 Q6 _1 D: L5 N9 V
- }; W0 m& d6 y; {, T0 E: a; X
- else if((timeCount % (timeDivide + 1)) == 0)
# I0 s( K2 f3 s4 H2 ? - {
: Z6 J$ p' x6 B4 t" ^ - txBuffer[0] = CodeNak;
( L! m# y6 J7 N! C - txLength = 1;. P5 v+ P5 [. d6 x6 j5 R6 g
- write(txBuffer, txLength);" v- R3 _! a" Z4 n, h
- }# E$ @5 n+ p1 T/ f7 m( }4 Z* R) B) V
- }8 E0 c$ l" G2 W
- }
# @# X+ K3 X- V, H* h M - }
3 M1 l8 D3 W( q: k$ ^
" [, L+ }, l/ C0 X7 i- /**
% v- `0 f3 V9 y - * @brief Transmit none stage.
( N1 T) z1 U6 N$ Y4 j; Q# a - * @param None.
* j/ c: z- _9 |9 T9 }; {7 Z) F - * @return None.
& w& W& f# W# S: T8 {5 A, ^" M - */( [" t. g/ j- s1 ~( n- ]2 P" `1 S
- void Ymodem::transmitStageNone()
3 l! \% G; E' y8 |5 ^; F5 ]% M - {9 r/ q5 q* _8 I4 _$ Y' H
- timeCount = 0;
p2 I+ i: F! d4 K8 l - errorCount = 0;0 j4 V3 M' d& _
- dataCount = 0;$ }' D6 P. X( J* D4 L) c4 q( V* `
- code = CodeNone;$ g. k: J* l& s* J, `
- stage = StageEstablishing;. H+ _' j5 B0 W) k# x5 e
- }( b) C0 W+ q# h% X8 X
- / a- r6 Y3 i3 G' K% v7 W
- /**
U! b9 D" e% v. ?+ i: \ - * @brief Transmit establishing stage.
' }/ c% q8 ^ q. O; h3 L6 Y - * @param None.9 }7 _! n) M; {: V! C
- * @return None.
9 h' H7 S( P) t) x& J6 a0 _ - *// r6 T- ?: `8 O
- void Ymodem::transmitStageEstablishing()
. ?# t$ J U7 ^& u/ B - {4 b2 _/ m: C6 U* g5 Q r
- switch(receivePacket())
2 N9 ~# a: C3 m - {. P6 c" g: e- A8 U# k+ |" l
- case CodeC:
' W/ q G; c$ K. i - {+ ?' _4 [5 Y7 ?
- memset(&(txBuffer[YMODEM_PACKET_HEADER]), NULL, YMODEM_PACKET_SIZE);$ C$ I0 j) z/ ~0 K, b8 |% ~# \4 A1 a
- * s2 ^; k. L$ g3 c% i& {
- if(callback(StatusEstablish, &(txBuffer[YMODEM_PACKET_HEADER]), &(txLength)) == CodeAck)3 w( Q% g2 U/ w+ q
- {6 K/ s' |. l4 e5 E m% a; V' A
- uint16_t crc = crc16(&(txBuffer[YMODEM_PACKET_HEADER]), txLength);
$ \. `. Z, _0 \
8 L- C T1 h9 {! J' y- timeCount = 0;& s! J& P( M+ ]; p$ W
- errorCount = 0;; G, r) F% B/ q
- dataCount = 0;
, O# e4 ?, b0 \5 s; ]2 y - code = CodeNone;, C: |; ~8 e5 |; ~
- stage = StageEstablished;
1 ^! @, c& H9 ?& O+ G9 R% Q - txBuffer[0] = CodeSoh;( q8 g( ~9 L* I, d3 G1 ?% U
- txBuffer[1] = 0x00;
. @2 l( \2 @8 z z; s# M - txBuffer[2] = 0xFF;0 t" @+ ]& m. L& m% {! ]
- txBuffer[txLength + YMODEM_PACKET_OVERHEAD - 2] = (uint8_t)(crc >> 8);( E' J6 A# d5 m( o+ u# f l, b5 S) a+ y
- txBuffer[txLength + YMODEM_PACKET_OVERHEAD - 1] = (uint8_t)(crc >> 0);) e! j! e' [4 p6 |) U9 Y
- txLength = txLength + YMODEM_PACKET_OVERHEAD;6 ^* N Y1 V1 O# b/ I
- write(txBuffer, txLength);
$ s3 a. z h5 L - }
7 G& J! }1 A) U$ Q4 } - else
$ f' V1 j0 u5 A6 ^8 k - {
' b S! ~+ c' g2 ~) Q" E) M# p - timeCount = 0;9 I7 A ?5 i0 Q& L$ v- Z& H/ G
- errorCount = 0;
1 J- A% E5 b0 t# F. {9 D0 ^ - dataCount = 0;2 C, q+ D& r- @1 x: A
- code = CodeNone;* T% \4 ~4 R) y v
- stage = StageNone;8 j: m# E+ I$ G: A5 t) B1 p& X4 J
- , }8 J+ E6 b+ y1 F
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
; _" v$ i% o- j# e; T: f9 O- f! K - {
0 |3 p( M) R. [0 l$ u+ ?8 ` - txBuffer[txLength] = CodeCan;) B) i/ s$ d. y$ Y- k) @
- }
! [$ I# [' B& i- \6 b7 P
$ T& b; h% ?; m* q2 k- write(txBuffer, txLength);3 C! n9 `4 F1 n$ ?2 j$ u, Z+ J3 S
- }
2 V* T: G8 ?8 x; r( Y$ z
/ U. B, i$ m; G( O( m5 E# c! i- break;
" N+ s: Y9 x) w5 D5 t" h - }
- n7 H' ~6 |; E& L
5 e' m- w6 I% Z0 G- }4 d- case CodeA1:
) t# D. u/ U+ i& R+ P - case CodeA2:: j; e, y8 I2 R
- case CodeCan:# I ?! _3 m, T9 t) d5 T& L- [
- {
4 F* ]* ]" I* ]6 C; R2 o - timeCount = 0;
. o) j- u! Q: s) i9 K9 W - errorCount = 0;9 v- S# w( X- e, r
- dataCount = 0;- [0 k$ Z w7 f8 l$ ~
- code = CodeNone;
8 N" F/ N5 y3 `* i1 b! L - stage = StageNone;
. u) O: c! Q$ a: V4 {3 c* z; m - callback(StatusAbort, NULL, NULL); b# U$ z& d b3 J0 n" e( Q
- / n8 X; y4 c5 l \: r; c# F
- break;4 Q1 g1 d& I+ Q `
- }
. \2 @; l2 V( G; d3 d
8 S( P7 g% m+ J8 @- default:
" t4 S/ k0 ^! V" c" ]7 J - {- T# g- v+ G* `5 _7 T
- timeCount++;
/ g, F+ a3 J0 G2 W( v8 ? - I P9 E- p" D# [+ c) `
- if((timeCount / (timeDivide + 1)) > timeMax) F; N( `1 c0 V" G5 V! w
- {! A' q& X9 L- n1 n4 y
- timeCount = 0;5 o/ [4 k# m: N: O4 Y. e% ?
- errorCount = 0;' C2 A/ q8 x1 }6 d8 k3 ?! ^4 f( O. X
- dataCount = 0;- u+ E" O$ O: c$ ?0 C$ J
- code = CodeNone;1 Y; `6 m& ?* T
- stage = StageNone;
6 ^' ?/ Y. k+ {
3 ^ D% K; N( b; w% A- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
4 ~3 W* @* _9 c9 t3 s - {
9 j" q# l, p) J1 H; K; V - txBuffer[txLength] = CodeCan;/ a6 D7 |' K1 I. t
- }
$ S" H/ U7 E7 e - " e& p* e, \; A, e% X
- write(txBuffer, txLength);
3 T& x# t# |& W5 x l - callback(StatusTimeout, NULL, NULL);
6 ~0 p" Q9 H5 a1 s# `) N3 }0 K+ u1 c - }3 F L3 b5 r$ h4 H: F+ D
- }
9 B. x! B7 i# o- C+ H - }' g6 w2 f& [. i& B2 O. y7 S
- }. h$ T, |, o! L
- t: a4 L# z: O$ l, C$ p/ v
- /**
8 ^: G# o+ g- ? }: b - * @brief Transmit established stage.
- Q( I, }7 S# b* x1 x - * @param None.$ e; A; c. u- u! ?
- * @return None.# c; X" K" n2 ?
- */7 N4 T! z# p- s# m
- void Ymodem::transmitStageEstablished(); k- z( l" G0 t2 S
- {2 l6 n" [. m: e
- switch(receivePacket()). `5 M2 B- \" O! W, }
- {3 {8 x- Q8 Y0 p7 M( k" `1 Z
- case CodeNak:
' I7 Q' g. P" o2 k7 `! u/ V3 ~% k - {9 P: T6 q$ _( m; N& v4 ?; _5 q$ L! s
- errorCount++;& m/ R* G% i3 ^7 y* D* r2 b
2 i `1 t, L/ g" `( g- n# t- if(errorCount > errorMax)* ~8 n8 z; N; {
- {
) |8 r. V. i* z7 \5 ] {) L/ y - timeCount = 0;
% S" Y" G" w. y* L' s% L/ S - errorCount = 0;2 Y% S+ h0 O, n6 P* V# p; A( I
- dataCount = 0;% k* G4 p* W7 k- S& I9 p
- code = CodeNone;
+ j5 R4 g4 }$ a1 R- [$ w5 w# y - stage = StageNone;3 N8 O* X6 `5 \; T& m
3 [1 U0 \' W& _# q( W/ s# c& @- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
1 Z1 N' I {% M% [. Q. N% ~ - {
7 Q) ]8 I* l; ?6 d - txBuffer[txLength] = CodeCan;! k) F/ ]" S5 e) m# e1 S
- }
$ v9 O8 L3 H& R* C5 ^: o Z. y; N - ) I# L. v5 l$ k$ F6 H
- write(txBuffer, txLength);- _6 L2 H# T1 k1 y0 n- ?% q$ }
- callback(StatusError, NULL, NULL);
: C% F) p1 E" z7 _ - }
- M: |7 Q; E6 p" f9 F - else6 A3 i* _1 h) F
- {4 ]7 H: h0 n; T+ o
- write(txBuffer, txLength);
' l0 ]8 D( \& s7 e9 i s - }& ~# W1 }: d- A3 c
- % b9 |3 ?3 B0 [3 V- A# l# U
- break;
/ ]* M5 S. J% }" W. i" o - }
8 [, {6 O' w" ^6 v* Y+ F$ F# f Q1 i
- e: E' p. X, \2 _, R: ~- case CodeC:
; r: x0 j# @/ ?, \ - {
) j; _/ V! w( ] - errorCount++;
, q. v; w7 M/ B. N - 8 W( P1 x( A8 I, x/ ~0 h
- if(errorCount > errorMax)
& T' y! {% f( Z - {
; k/ H3 C i2 s - timeCount = 0;$ ~9 V6 C, y. ^& @: y5 T8 w# {
- errorCount = 0;
3 K: t$ w6 U4 ~" G/ E8 ]. v - dataCount = 0;/ H$ P1 d0 B5 _; V6 [
- code = CodeNone;- W$ A- v9 T$ n/ k$ a( {9 S4 P
- stage = StageNone;
# s. t2 U: T3 T. w: Y+ Z
; @% {7 W. { h; J; L% d# X- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
# `' C7 v' [5 _; s6 c* ?' E - {9 x! c( j! `! e! u2 D/ T
- txBuffer[txLength] = CodeCan;$ a' J( I6 \$ H% }8 l4 n
- }% k/ ^1 w% `5 c6 b
- % D! H5 f4 i( C7 @( x7 L3 ?) ? u
- write(txBuffer, txLength);
2 l' @+ o1 W2 I @0 u - callback(StatusError, NULL, NULL);* z' N- g; v5 ^4 H% q; l; N
- }
9 v7 K2 k1 t- u V S/ ]5 T - else+ N3 j) Z t" d3 P: X5 K- }. Z
- {
$ h0 V* B3 ~4 O( L0 t) M - timeCount = 0;
V6 n" N& C" f$ `- E- d - errorCount = 0;- W: O% \$ g+ G l" T
- dataCount = dataCount;! Z' [# h* l: P9 t- _
- code = CodeNone;
1 P% ]3 A0 C, d" ^6 {! w7 E - stage = (Stage)(stage + dataCount);
, W4 D O! V9 d5 P( s8 t2 b8 T - write(txBuffer, txLength);
5 U( ~* \% e! E U! r - }3 a5 e" g! J5 }+ A& }
( r; D! T2 L& e0 m" |2 h- break;
1 y9 ~! r: h, F5 V0 B$ a0 N0 N7 ? - }
* _+ V, n6 A0 Q) Z) l3 _
* J( V. g9 r+ |0 z9 t& `- case CodeAck:
8 o8 u+ g) T" b$ l - {0 w1 ]4 ]% S3 `) k
- memset(&(txBuffer[YMODEM_PACKET_HEADER]), NULL, YMODEM_PACKET_1K_SIZE);
8 g/ a# y4 |+ H4 x% F9 e: {
1 ~. E' E& X! Y: f6 i; e% C- U- switch(callback(StatusTransmit, &(txBuffer[YMODEM_PACKET_HEADER]), &(txLength)))8 d, G; w) t( q1 a
- {, Z. A; x" n2 Y
- case CodeAck:1 V t( K) g% x$ o
- {
( G6 Y; O; `8 v( v; E! G - uint16_t crc = crc16(&(txBuffer[YMODEM_PACKET_HEADER]), txLength);
+ G" A" U$ J$ p4 c
! k+ @; P( e D5 u- timeCount = 0; _" C3 D5 @8 C |" G
- errorCount = 0;6 l s/ ^ w& q% W: J! Y% z/ q0 k% V
- dataCount = 1;6 \+ n" B& ~6 s; g
- code = CodeNone;
$ X/ U, j2 n1 T - stage = StageEstablished;
/ W( D r5 G' Z; ]2 e - txBuffer[0] = txLength > YMODEM_PACKET_SIZE ? CodeStx : CodeSoh;
; {: [$ \7 ?$ c - txBuffer[1] = 0x01;$ U9 a o) v0 i; Q$ P
- txBuffer[2] = 0xFE;
9 h W3 l; g+ @7 F! n- ?8 L - txBuffer[txLength + YMODEM_PACKET_OVERHEAD - 2] = (uint8_t)(crc >> 8);( n3 P) ^" d9 X: s! Z
- txBuffer[txLength + YMODEM_PACKET_OVERHEAD - 1] = (uint8_t)(crc >> 0);0 M6 c/ A) c6 `4 e9 D- l
- txLength = txLength + YMODEM_PACKET_OVERHEAD;
. {) G3 u- K4 v
& i& n; r' N2 y# @1 c- g/ U# ?; ^- break;
6 k& O/ y4 P C7 L/ G, g& Q' [ - }7 _( U7 C' |% S0 l9 N9 _
- + m/ K" [( ?, X# W
- case CodeEot:
% {9 Q0 B6 a8 K; U0 N3 W - {' D- M3 y/ d$ n
- timeCount = 0;
+ V# z/ k0 [% ` - errorCount = 0;
/ b; R% G% e( E) d# @+ r/ I8 e: L - dataCount = 2;; R. A+ _& M& q9 Y" W
- code = CodeNone;
6 D+ E! y" c6 X N u$ L - stage = StageEstablished;
# |# U' C5 X% ]3 t. b - txBuffer[0] = CodeEot;
7 {7 i, A; C( S! I" P( ?* _$ x - txLength = 1; |& N7 z$ E$ J' K& F: I
- write(txBuffer, txLength);
( O9 J5 u% Y* ~6 d) m+ s
8 T: R$ I4 ?- c; w9 R+ T- break;, s3 k, T" T, J# w! J$ d1 K; L
- }* n2 o1 Z f, i
- 6 B+ t0 m) T2 j9 v0 B" }& x) i$ e
- default:/ v4 B, r% l9 Y8 w- n: E+ k- ~( C
- {; M8 W2 p# O9 F+ v- d0 k* y+ I
- timeCount = 0;
* [( m( i- l# `; d - errorCount = 0;, d2 |, [! t7 _. t- O' L: ~8 N
- dataCount = 0;
# v6 c$ D) ]" H1 Z' B - code = CodeNone;
5 `( L- |% D$ m4 F - stage = StageNone;3 N; t- S: o' G6 ]' [% r
- 1 r2 o' D. V4 q7 a8 d
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++): D1 d0 N/ ]2 F: T* Q0 o
- {% P5 U$ \7 _ j( V
- txBuffer[txLength] = CodeCan;
% e: @) X) ^: H6 k- v- x - }
; s5 p5 I- _! J5 d5 [ - 6 d8 }2 D6 D8 X: u* @# |
- write(txBuffer, txLength); {' I& ~' B. D
- }
0 P- P( k5 n1 F* w1 y" z) r - }
5 b- x) q2 c) [; B - 0 ^8 O4 e9 |5 z! ~% _1 \# g9 W6 |
- break;3 r& j: |; ?( p1 o: }" v. c0 _
- }/ B" v" D0 U/ F3 `! }1 b
; _9 D( @' m! n, A8 S6 J; v y- case CodeA1:! t0 r. q! q0 v* o
- case CodeA2:
$ Z- ~' _- L$ W. |4 v - case CodeCan:; v0 `5 C- s' J( G: Q) }2 ^
- {
% p8 ]. [- K8 Z. B. w( S& d - timeCount = 0;* F* I% `$ f0 [ r
- errorCount = 0;+ S/ {6 _+ i- C% l2 C
- dataCount = 0;
: f' u6 }3 n( l( c) Q1 p - code = CodeNone;
$ ?- D! @8 c6 A& V4 q6 \ - stage = StageNone;1 v3 t6 I5 C, Z* _4 F% F1 l
- callback(StatusAbort, NULL, NULL);
6 }1 J ?% I8 D! Y4 L8 g5 B
( V0 {6 A3 c. a. V% T& e! j( b- break;
* Z$ X. r8 j6 R - }
0 ^% o! h- s( Y( o
+ W m; B, @/ I/ k6 Y0 C: F! X; z5 g( @- default:& x: O( @. C2 v; J# {. p. i9 f
- {
/ u' ]2 o: p7 f! H5 Q: ?9 X - timeCount++;' {, P0 |8 r0 u* T* q. x: E* x& v
- j8 V! t' A* |& @( e9 f/ ~
- if((timeCount / (timeDivide + 1)) > timeMax)
: L" e. O2 F! `" B% y: D5 G* | - {
1 O8 } v2 F8 q - timeCount = 0;' ~% p: M! U$ c6 g7 S4 C' G
- errorCount = 0;1 j( a% `) u# U
- dataCount = 0;
8 w5 O) _9 x1 U: v9 w( n" I' E# y2 l - code = CodeNone;6 M; G' P: T& G+ J& X! j
- stage = StageNone;$ |9 J0 j( f6 K d6 h3 K
- e) w: R$ Y0 ~6 s$ ?9 X% D
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)) |+ G( p( |4 A$ c/ }5 O( b8 C
- {
5 _8 p8 [3 ~4 q2 k- |9 ] - txBuffer[txLength] = CodeCan;4 G2 t2 {3 b$ e6 D
- }9 ~8 J+ `. a" z0 |; X
( G4 {) A9 f) M S$ Y- write(txBuffer, txLength);
8 b$ m& g4 ~* G* X# n7 P! S) u - callback(StatusError, NULL, NULL);/ \# S. e% f2 P/ |
- }
% f( @8 x. Y! {1 e# _/ i2 C n - else if((timeCount % (timeDivide + 1)) == 0)
$ n+ S0 q: p9 D+ k) D0 R( u. L! [ - {
$ I: m0 a5 P- L$ D9 Z' L5 s) p6 Z - write(txBuffer, txLength);
! M. @7 G' D X% c - }" N; z. V4 a2 q+ }/ O5 X, @( t
- }
+ p* W. A, Y& G - }7 t7 }" y5 F# J% ^
- }
( F5 {& j! Y! G+ Z
1 X0 g$ m' [- ?6 U: w5 h( o- /**
1 p+ b9 X+ K( J$ l3 r# N4 g - * @brief Transmit transmitting stage./ o1 S2 q# o0 [+ A$ \- c4 f
- * @param None.6 N# h, W1 O. ]1 s. W' f# \
- * @return None.$ j0 Q; w& o4 i
- */
" M1 ?3 q' l/ w+ |" ?+ h9 A - void Ymodem::transmitStageTransmitting()4 B% o2 F$ M; N! V
- {
; M- b9 y4 o% s6 R - switch(receivePacket()); J; q2 G* f8 |: Y3 L. [
- {' W5 h8 |# z- F& L- [
- case CodeNak:. _( Q( Q2 s6 F# L: J! N1 [% D
- {
8 F5 C/ F+ g2 `: i) t - errorCount++;
) w+ D: M- |' {4 P
. x: z+ e* a( L# f9 A- if(errorCount > errorMax)1 Q& Q1 P6 N% y7 x! W' E
- {
) z5 h7 X8 h& c- @. E! b% P# E* ? - timeCount = 0;, v% ~. l# r+ m( H3 Z
- errorCount = 0; [ a& D o' F: `- ?3 x. d* P& m
- dataCount = 0;
5 m- w/ |3 W& @9 R/ T3 s - code = CodeNone;
2 Y( A7 e, s$ S! ^ - stage = StageNone;
0 M, C& A1 ]7 N8 a7 Y - ! K* h6 I7 X5 L% U7 r! e% ]! w; X
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
" ]1 s' H$ ]% N( Y4 U! r6 d. C. ]2 Z - {
$ e" }8 h, r: e8 m% j' l9 Y - txBuffer[txLength] = CodeCan;% Z* X0 q8 G- a* O6 v
- }2 X/ f+ s1 N; K; H! }
3 Z* t: @, }9 D0 Z- write(txBuffer, txLength);$ P3 b+ W! p' \+ \; x/ j1 q( f
- callback(StatusError, NULL, NULL);
7 U7 f# W/ E' l' G4 ^ w - }) S) [! U) }1 h; X
- else
/ j: P1 E, E! p0 D" T - {2 |1 a* y; V" J! ~5 z
- write(txBuffer, txLength);- k& V3 X, Q4 ?, r% L
- }
6 c7 t8 g! }/ T \) c
G$ i& S, O& r( }4 U1 S4 X, w- break;
$ c' N- L0 Z8 S; L5 h! H - }
5 K9 ?" d e1 f* n3 W6 @5 D* ?+ ^* ? - . m+ T$ J4 d- L
- case CodeAck:8 f2 r0 l* B; J' O% U
- {. r& \, m& J9 |
- memset(&(txBuffer[YMODEM_PACKET_HEADER]), NULL, YMODEM_PACKET_1K_SIZE);
/ n9 u3 Z+ ~6 T3 p5 d - 8 O3 B4 h5 O, I) n4 b5 s
- switch(callback(StatusTransmit, &(txBuffer[YMODEM_PACKET_HEADER]), &(txLength))), {, q% m$ g& e5 V8 }
- {
4 F5 |* d( ], s/ O3 l8 m - case CodeAck:
4 [$ o/ g: g4 ]1 E8 d/ ] - {
6 ^8 {/ X/ i1 g6 U - uint16_t crc = crc16(&(txBuffer[YMODEM_PACKET_HEADER]), txLength);
3 N1 X/ r9 ` ~0 Q5 m8 c
2 ~; B7 T$ t* m/ V- d- timeCount = 0;
# I% d. {3 r0 H - errorCount = 0;# f. ?) J$ B2 Z' I
- dataCount = dataCount + 1;5 ]9 T( l4 E; v" o
- code = CodeNone;! q$ z* v- z/ A: H3 R' x( o# |
- stage = StageTransmitting;$ A+ k0 i; d9 Q( T
- txBuffer[0] = txLength > YMODEM_PACKET_SIZE ? CodeStx : CodeSoh;6 j' @. Y2 w8 p. c
- txBuffer[1] = dataCount;
% ~ a9 p# {; |0 \ - txBuffer[2] = 0xFF - dataCount;
+ g1 d$ ^/ ^1 b; Q - txBuffer[txLength + YMODEM_PACKET_OVERHEAD - 2] = (uint8_t)(crc >> 8);, P6 Q& t {4 c. }' X$ B @
- txBuffer[txLength + YMODEM_PACKET_OVERHEAD - 1] = (uint8_t)(crc >> 0);& Q1 p) s1 e+ P
- txLength = txLength + YMODEM_PACKET_OVERHEAD;+ p) N b( p: A# h2 }
- write(txBuffer, txLength);
3 ~( J0 j/ J7 F9 R, G! L - , v( w/ F7 S M
- break;
" m* n2 p! ^- I - }
r" P, L6 C7 |# Z) `5 g - / D# z: M( c+ I
- case CodeEot:
# x* n8 m; T( ]4 P& R! z - {( s9 f. x* W* b- V, U o1 }, W
- timeCount = 0;% J# o: }! G7 ^% ]9 x$ ^
- errorCount = 0;4 ^/ F I, p$ L6 _
- dataCount = 0;6 m. v2 B* r& }" u i9 U6 A/ r
- code = CodeNone;
6 Y9 \2 g. f- M F - stage = StageFinishing;1 ^+ X5 @! w* O7 d+ g/ T4 t
- txBuffer[0] = CodeEot;
3 S& T' Q- i# n6 i. e - txLength = 1;& c6 L+ ?: N# e8 E( p9 D
- write(txBuffer, txLength);
4 m c( S# A* {9 e7 {
& D# t$ G- _* k- break;: L0 C* d" b" ~) D- I/ @( \* E" E
- }' ?# l; p v- N8 c* e( Z
' D, G4 |& l" [$ K1 l- default:; S4 r/ E A! Z/ b8 \7 x( H2 n3 u
- {" R9 z# q2 g) K( u; c5 T+ C2 l
- timeCount = 0;5 q2 z; b6 b/ U# o$ u- F
- errorCount = 0;
7 O( N) I0 r2 F! P - dataCount = 0;
- L/ E5 _$ ]8 X7 } - code = CodeNone;
3 o2 g2 f: P8 s% l# M9 `+ U7 j - stage = StageNone;
" J; ~( T/ N w0 E( |# v2 y
6 j: \( F Q O; Y3 ~& V" P- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
/ }" @1 e3 t1 b1 y& @" P# L - {
$ e! h: E0 p/ q) Q. \ G - txBuffer[txLength] = CodeCan;
6 n. O* e$ ?/ z1 }$ ^/ a2 ` - }
2 S5 u* v! q1 I, e8 Z+ V
+ q! c) b2 N' o5 ^5 N/ R- Y7 j( p, p- write(txBuffer, txLength);! r2 \) B5 ^5 o
- }6 I6 e" y& r; P4 I
- }" z# k# P6 u6 @$ l/ o7 G% G! j3 U
# _: C; y2 {- p- break;
( Z: ^" n/ b/ e+ {' n6 q - }: z& X7 A) ?) n; v, p
- . z' ?# I6 Q8 F: l! A; A* Z$ g
- case CodeA1:6 s: ]! ?* }7 U: ~0 |
- case CodeA2:' M% L( I& [1 f. n* O7 p
- case CodeCan:' r4 y9 ]' F* j l
- {
3 ]+ _1 O% L5 ^$ A* I) [0 g) F - timeCount = 0;
0 ]2 K7 M* {) J& r0 b8 ^ - errorCount = 0;
2 L( C; u' c! [" I/ c - dataCount = 0;
e4 E- d$ S* o, Z - code = CodeNone;: [+ ~2 \! g) _ I* g- L; w
- stage = StageNone;
: f1 S/ z8 ~/ b. y4 p4 Z - callback(StatusAbort, NULL, NULL);
# L1 w8 U3 p) j' A" V+ _ - 9 M8 Q2 ~; @$ @7 M' s5 b" N0 l
- break;; \1 P$ N9 d$ q( H q1 v) h0 K+ q
- }
& U& U9 }( w$ A
9 r# e; V* }/ k- default:6 j0 g* g( W2 ^2 R4 ?8 L
- {& ~4 H0 G6 h1 @0 U) I! H
- timeCount++;
% i2 w& l& c2 H9 m - } I; `& O2 a% J$ l7 I9 N% ^
- if((timeCount / (timeDivide + 1)) > timeMax)
) {' @ B4 `, q3 C4 P - {2 _/ K4 h/ V/ P$ Y% `9 s0 s* }+ I8 k" B0 u
- timeCount = 0;6 \9 A& `, W( q, h+ @
- errorCount = 0;. g% ?8 ~$ C2 w4 l" x; s
- dataCount = 0;/ w* V9 o7 i: K4 Y
- code = CodeNone;. k/ s1 |1 g c, u' W
- stage = StageNone;
2 z: c' L8 Q; `# o9 Y O
) L( k- o* \: J- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
* Z/ q: y( D' r - {& C# m0 n p( Y0 T; `0 A
- txBuffer[txLength] = CodeCan;4 l: d: M# o0 ]7 t) t' m$ m
- }
4 u1 P1 f$ A5 H, g, G
! n" R) Q, a0 N# n' G! F4 ^- write(txBuffer, txLength);) X3 J2 m; R' M; F8 r$ k4 h1 k# n
- callback(StatusError, NULL, NULL);. G5 J1 g% U* T6 W3 u
- }
6 ~ Z& O: w6 L( k* c5 [* v: p - else if((timeCount % (timeDivide + 1)) == 0)
: r- C \7 a( O O6 W5 e& T) r2 C - {4 V% \- r. t, [! H1 ~5 @
- write(txBuffer, txLength);
) a. b/ x7 [* @1 d - }
+ o$ Y0 S$ c! d' |9 M - }$ J; Z( x- P9 G. p! @
- }
' a& p$ ]# b# F2 [6 D+ f" b - }
; ^) _. \2 J: Z C1 r0 W6 M" z - ' }6 n$ N4 O' s- Z! ?
- /**+ l6 y1 r; t4 T2 z. S; K1 A& h- r
- * @brief Transmit finishing stage.
+ {& `3 a5 c P/ I* B! u4 c3 v: f - * @param None.* `2 }5 c; V( V
- * @return None.' [: ?- I d7 _) n9 E: C5 T
- */! G% t" e+ C: F% h q. Q- u; y ?: G) ~
- void Ymodem::transmitStageFinishing(), O. I5 G, M; ?! L4 w" g4 {
- {
" G% V ]% a5 L! _7 {: } - switch(receivePacket())
- u1 V) ^6 Q1 [ - {
, p1 ?7 h& ~8 M - case CodeNak:0 J3 [6 N% w; D- z
- {
8 o2 M3 u; G: }" g. w- B2 ` - timeCount = 0;4 Y. m, l1 F# C( z
- errorCount = 0;8 m# T- f2 r* Y1 q& a5 w7 O
- dataCount = 0;
2 b' e4 w( {' _" m - code = CodeNone;
, _* {1 R# ]# j6 b9 {# i1 E" @/ | o - stage = StageFinishing;& B( X5 q2 Q7 |0 T' I9 m8 ]
- txBuffer[0] = CodeEot;
: _& q$ @/ M1 m# F- P - txLength = 1;9 W5 [1 \6 ^' V! J) `
- write(txBuffer, txLength);( s( ]- l3 S; C( a h
" I& e& k! d5 v( k9 N- break;4 o' R# h* f3 g. H( d3 J
- }) R2 D! D. S5 Z! u4 U3 t0 X; a
0 z1 |: I# w L: h1 G% r: M6 I/ o- case CodeC:- f' f! E9 N+ d3 g! [" p N
- {
5 V0 A$ ^( p6 N9 P7 @. [5 E$ ~ - memset(&(txBuffer[YMODEM_PACKET_HEADER]), NULL, YMODEM_PACKET_SIZE);
% ]- N. c* n+ L9 S2 g; k - uint16_t crc = crc16(&(txBuffer[YMODEM_PACKET_HEADER]), YMODEM_PACKET_SIZE);5 I2 ]( y- U" d' |4 g5 x
; K* f5 `1 _5 s" e& L7 ?- timeCount = 0;
W, K4 X# c' _# [; ^0 d% K8 j: [ - errorCount = 0;
) I' p- Q6 t& e* c: D7 E - dataCount = 0;
R, D8 i/ E3 \3 ]& l) c- Z1 H - code = CodeNone;- ~" C/ ^+ `- Z1 F+ J" E- m9 J
- stage = StageFinished;5 v+ [8 R6 y) I! q# q" F) P
- txBuffer[0] = CodeSoh;
u% ]! A* l6 d, | - txBuffer[1] = 0x00;, G' c' ]8 P; \# t" i+ x
- txBuffer[2] = 0xFF;: N* {: X" U7 x3 U
- txBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 2] = (uint8_t)(crc >> 8);
- ]3 m% P9 d' ` m$ ~ - txBuffer[YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD - 1] = (uint8_t)(crc >> 0);6 _: H+ `3 D' U" I9 G& r) Z" q/ j
- txLength = YMODEM_PACKET_SIZE + YMODEM_PACKET_OVERHEAD;0 H# h/ P& o- I
- write(txBuffer, txLength);& W7 ^: N' A. C* u
8 a8 F" f7 f/ F L" l$ b- break;6 R4 T) u! P' Y3 K+ P
- }. q& V$ j7 t7 g5 F* f4 W; K- ?/ v6 T% ?. T
H% _6 q) w9 q- case CodeA1:
- n3 N4 J5 k, [- O5 N4 E3 h- I - case CodeA2:
6 ~+ X7 a% {6 G, a; G4 c4 F - case CodeCan:- M! ?; f3 _3 \1 H0 e
- {: ] O8 `5 q5 c
- timeCount = 0;
5 g, q4 K, f) V* w8 \5 d8 L/ Y - errorCount = 0;
! u" Z$ j0 X: o: E5 [ - dataCount = 0;+ e6 _. l- Q; @( A$ N+ ]
- code = CodeNone;
3 z# \! E; W2 U5 L3 f - stage = StageNone;
- v3 d) P1 [/ ?+ h - callback(StatusAbort, NULL, NULL);
9 a0 \6 x. P7 v4 U: B- N$ C# e
6 j5 X$ ?7 P# M4 @) l- break;4 }) b/ U0 Y4 p# _
- }2 S6 Q* n O6 K$ M! R/ ^
2 k4 | n X. V! }& a) s/ D2 }- default:
{2 p, m" V* ]% o; ]- Z - {
% O+ u# e9 Z4 A$ o3 S" a - timeCount++;
9 W. G* G4 i. q/ A; u3 s - 6 v$ I6 Z2 V& u: a
- if((timeCount / (timeDivide + 1)) > timeMax)
2 G1 u% Z! h1 R& t8 p. Z. r - {: h) u2 ?; I3 C- s( k H. `
- timeCount = 0;
0 s2 l( R5 |0 E. I - errorCount = 0;/ I+ C' D9 k* M
- dataCount = 0;/ S$ o3 |, t3 {$ R; f9 O$ v+ n
- code = CodeNone;
g, s+ B: _' @/ A! [: v6 _ - stage = StageNone;
& X5 l3 J; h# _ - , B# _6 F: v+ N0 e
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
' v1 M8 V+ o" D% L - {
6 X* a- q% H7 i' l5 W' A" c$ k - txBuffer[txLength] = CodeCan;
( V3 E* T' s% x9 Y% i) R. H - }/ U5 j( C+ s$ W$ ~
- 2 C# a( P1 Q7 h
- write(txBuffer, txLength);8 x2 Q6 C8 S. F# z, f
- callback(StatusError, NULL, NULL);* p) W% z4 M/ B7 ]
- }7 p' o4 T9 c8 _, q" g/ X: p
- else if((timeCount % (timeDivide + 1)) == 0): k; A3 H# b( O$ S2 g9 A
- {; T$ |8 W9 g3 E: m3 {( l1 j
- write(txBuffer, txLength);- F/ o* L: E( N! s* p1 ~
- }$ j) j3 S- T# _/ U, G7 \/ [3 g
- }7 D4 E, S4 F3 ^5 M4 |: q9 P. C
- }
" c- v: a- P' N9 b6 g - }
9 s- r% X+ }% q* {* _7 y. _0 B% q - 1 g$ v4 u& B4 {, H0 x+ T6 \
- /**- Z, {/ a7 k# w2 ^& I2 I
- * @brief Transmit finished stage.
. Z' h9 Z/ A* `# G' n- C - * @param None.: M- W P, w \! }1 }" s
- * @return None.
5 X# i9 i& K- R0 m' Z, p - */
6 d$ O1 o1 z% F; u+ ^2 W8 T - void Ymodem::transmitStageFinished()
. ]2 _- o. O: R. }9 u - {- P. S6 c8 B4 C' k2 l5 S
- switch(receivePacket())# e) b9 ?0 S A$ ?
- {& Y+ k* C1 s- h# q9 \4 ?
- case CodeC:3 K( k8 k L# S! o3 X. P$ J
- case CodeNak:
3 J4 s6 L T' ?) V) ]# @6 ]. { - {
5 N; P) X2 t3 g( F7 C* O" m - errorCount++;
5 u) U6 e) h3 T
! _& `* r$ I, F) V% s- A- if(errorCount > errorMax)7 Q. I8 Y% Y: Q: K- R% J' k5 Z
- {
5 l9 J9 l5 K8 | - timeCount = 0;
* c/ E" s& A; V9 W5 ] - errorCount = 0;
+ i* ]9 R! D& G2 @$ G7 m; | - dataCount = 0;
: Q/ `# z0 u$ ^- P - code = CodeNone;
* i; L$ \% U) r! |) x) V - stage = StageNone;) b- w$ [) d/ {+ i
; b; y% T0 Z$ T4 r, b+ e0 s- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)
% i W. y- ~: N& R n+ t2 r - {8 u5 y$ v4 |. T, [2 u
- txBuffer[txLength] = CodeCan;
1 @# V- A( _; X8 l, q; ~ - }0 h* U" h$ V2 r4 a; V; R
$ h* P( @- F5 K- write(txBuffer, txLength);1 ]2 U, m, |' m* R* J2 }# {
- callback(StatusError, NULL, NULL);
/ H5 l1 e. G6 Q) o" s0 F* X - }$ A) @; d5 u' ?
- else
" Z! f# {& x1 S" {. E% _' H) G - {( A- U t& F, t6 j' C
- write(txBuffer, txLength);
5 B& \7 J7 f! B4 n- T; {2 y$ X - }
. }: P+ v5 R9 o4 D3 B$ Z$ i - 5 p6 O- W2 A, Q: Z, u
- break;
) l1 F. ~/ c! c- v - }
$ \6 J# d) V2 o1 W1 t
. _ q/ T, P8 O( y- case CodeAck:* S2 P. k8 b% _9 p5 \
- {# G% I0 \ h" a1 }! r
- timeCount = 0;
; d6 T5 p; X0 O+ w) s- Z - errorCount = 0;6 \/ j5 ~3 m$ E3 q
- dataCount = 0;/ e i" ^+ A; M& d$ w
- code = CodeNone;
0 l A' u' N' [. l - stage = StageNone;
+ \2 j) a' D, [) J8 O - callback(StatusFinish, NULL, NULL);
7 r: l. ~+ c; b& t
1 a- x. W) _1 g0 u2 s- break;4 t$ R! K1 W. b; Q9 v7 E# n. o$ m
- }0 f+ F: ?2 Y. q0 r3 q/ X
- % s. V( o: Y9 x' L1 k
- case CodeA1:
8 }' ^8 l9 @' b3 [/ `1 W9 a0 f - case CodeA2:
+ e p# A& E& W: _ - case CodeCan:
0 y5 ^4 ?6 i6 M/ m5 x - {6 I. x k7 h- e
- timeCount = 0;
3 {0 g7 w1 U4 S/ [9 U - errorCount = 0;
" V' m3 P/ I+ T0 q2 R, L4 n - dataCount = 0;9 E2 F( z0 v8 ~- A1 a" V5 l; F% \
- code = CodeNone;
2 u/ \$ i$ T! g( C: c - stage = StageNone;
) t: |* x9 j% X! ?8 a% y - callback(StatusAbort, NULL, NULL);
9 P# k4 I6 k4 h - 6 u7 V7 }) U/ u. [
- break;( ?1 ?% u7 p8 ~9 D; ]" f+ W
- }; s) u5 W- g) ?* J2 q; @
* F/ N: Y8 D0 g! @ ~9 C- default:* [' K9 v. y$ C+ p
- {
# [. G+ |1 a4 C y( L! t - timeCount++;! Q% t" |. f8 {: A( K
- p0 D" T A5 U8 K" ?
- if((timeCount / (timeDivide + 1)) > timeMax)
" B2 L4 Y7 b0 Z5 g7 D6 M - {& a1 ~$ n/ n% `5 h% K
- timeCount = 0;0 N* K- F4 S$ S) }! {! h
- errorCount = 0;
: I. ^( A) |7 a - dataCount = 0;
+ P; y+ w7 F3 P) V - code = CodeNone;
) _! ^' l0 ~5 I$ l, Q - stage = StageNone;
: q* c( P4 x; f3 N - ; Q1 y' Q8 s5 j7 ?3 w
- for(txLength = 0; txLength < YMODEM_CODE_CAN_NUMBER; txLength++)6 ?; U+ v: V3 A) Q' c
- {/ g9 ` i/ l5 v1 d5 Z0 J, d* Z7 l
- txBuffer[txLength] = CodeCan;' l1 u. F M7 x& M( }8 q" a9 K
- }5 P( C" N' \2 v+ O+ p
; f& l# x9 W! |' ], }& G- write(txBuffer, txLength);; o* [1 A N* J5 z* W+ F0 v
- callback(StatusError, NULL, NULL);
4 Z& X% }# ?: g - }
: }% `2 `% H8 p - else if((timeCount % (timeDivide + 1)) == 0)
! d: ?9 ?8 T, L5 L8 k; S - {! }/ f+ M6 [0 m$ F `: C
- write(txBuffer, txLength);
, [/ j M6 o( ^7 [" h4 F - }
; v& b# Z) j( t4 M* i - }
0 p2 ]2 e& I |2 ? - }$ _1 ]6 {7 P! ^4 @ D
- }' p1 x, Y. W( d8 ]6 Z/ R; z
: E# A9 W+ x- s: n! i# l- m+ x: q; o5 E- /**
6 e# C6 L" W+ T6 { - * @brief Calculate CRC16 checksum.
. @9 u) N# U$ c. J) M& P - * @param [in] buff: The data to be calculated.
' n Y2 H( z+ c5 @ - * @param [in] len: The length of the data to be calculated.
) Z" S( p1 q: h! d4 M# s) W - * @return Calculated CRC16 checksum.
1 N0 k" j- a1 H8 `$ } - */! A4 g2 b+ ~- @+ @: C
- uint16_t Ymodem::crc16(uint8_t *buff, uint32_t len)
8 |* M! N' L9 B9 I9 V - {% _# j& N/ w0 C
- uint16_t crc = 0;; \/ b; W4 B. y3 F) p
- : j: s4 n. c' r! T7 p/ L
- while(len--), _& _* Y, d3 K& ~( s
- {
. S0 O1 M& C- ^) Y - crc ^= (uint16_t)(*(buff++)) << 8;
% m2 h3 T) e1 b
$ e* }. I; ?, w( X/ l, O' t( a$ D4 c- for(int i = 0; i < 8; i++) i8 g3 B* N) i* R' ?
- {1 ?2 E1 S1 I: B Z! J/ h
- if(crc & 0x8000)1 `7 o1 }% @0 r) M1 K* ?
- {' O7 s" ^0 G: R8 V7 b2 \' X! W
- crc = (crc << 1) ^ 0x1021;+ U; ?" b- x( j. H( o
- }
4 S- q* D6 ?1 P* @4 w, i& G* c - else
0 M5 A' Q3 D8 C4 V+ m$ x; P - { d$ e" S! }* h( {& U; t
- crc = crc << 1;
( S+ L4 |* e, j: J7 a1 i - }8 [% U4 W) u* o% J
- }
3 |: V+ L. U& G - }
2 i6 a+ h* I0 u9 C
+ h" [* s/ m9 Y4 e; L2 D- return crc;: V; m6 p6 Y6 |2 b& a3 h
- }
$ Q4 b3 c; X7 Y& u) }3 C
复制代码
i. w6 z) I0 ~% R" [1 B- n1 O4 k2 S+ B' O) @2 U
9 I5 _5 h: \$ E2 H
+ e" b9 H. e" O! S: G& |9 u
|
YmodemFileReceive.cpp文件
' a; v2 E# \7 j# i) x/ g
YmodemFileTransmit.cpp文件 `+ F q3 ?% F! ~: K+ h- J; g
: y6 a& V) n. g: t' ~
widget.h文件
widget.cpp文件
( X- w: G" _6 V3 C3 B' f
" o8 l4 A! q; a
SerialPortYmodem.pro文件- ~1 [& ~: {& _2 a: ]
SerialPortYmodem.ico文件1 t2 Y' P V; o
3,运行效果
& [! ]# Q- G4 m
GitHub仓库有工程,还有资料。
https://www.stmcu.org.cn/module/forum/thread-615031-1-1.html