From 28eeca8158d9816bb28d89c3adda8b6970c01367 Mon Sep 17 00:00:00 2001 From: BlackMark Date: Sat, 11 Apr 2020 21:17:10 +0200 Subject: [PATCH] Move transmitMessage to message handling part --- stk500v2/main.cpp | 24 ++++++++++++------------ 1 file changed, 12 insertions(+), 12 deletions(-) diff --git a/stk500v2/main.cpp b/stk500v2/main.cpp index 8f9f6ad..95e819e 100644 --- a/stk500v2/main.cpp +++ b/stk500v2/main.cpp @@ -64,6 +64,18 @@ static inline bool receiveMessage(Message &msg) return true; } +static inline void transmitMessage(const Message &msg) +{ + serial.txByte(msg.start); + serial.txByte(msg.number); + serial.txByte(msg.size >> 8); + serial.txByte(msg.size & 0xFF); + serial.txByte(msg.token); + for (uint16_t i = 0; i < msg.size; ++i) + serial.txByte(msg.body[i]); + serial.txByte(msg.checksum); +} + static inline bool isSignOn(const Message &msg) { if (msg.size == 1 && msg.body[0] == CMD_SIGN_ON) @@ -394,18 +406,6 @@ static inline void handleMessage(Message &msg) formatErrorAnswer(msg); } -static inline void transmitMessage(const Message &msg) -{ - serial.txByte(msg.start); - serial.txByte(msg.number); - serial.txByte(msg.size >> 8); - serial.txByte(msg.size & 0xFF); - serial.txByte(msg.token); - for (uint16_t i = 0; i < msg.size; ++i) - serial.txByte(msg.body[i]); - serial.txByte(msg.checksum); -} - int main() { serial.init();