+ while (SoftUSART_BitCount && TimeoutMSRemaining)\r
+ {\r
+ /* Manage software timeout */\r
+ if (TIFR0 & (1 << OCF0A))\r
+ {\r
+ TIFR0 |= (1 << OCF0A);\r
+ TimeoutMSRemaining--;\r
+ }\r
+ }\r
+\r
+ if (TimeoutMSRemaining)\r
+ TimeoutMSRemaining = COMMAND_TIMEOUT_MS;\r