X-Git-Url: http://git.tdb.fi/?p=model-railway-devices.git;a=blobdiff_plain;f=arducontrol%2Fmfx.c;h=293765fba9d7c8933106e48c6cdbc5ab4923cfa2;hp=6e843aa288baae240120ccfb0d527bfe278e148d;hb=57bb90d8019098a9b8fe63093498862ce6551017;hpb=188391bc43da8330aa4f9642bb1a23ef180d66e2

diff --git a/arducontrol/mfx.c b/arducontrol/mfx.c
index 6e843aa..293765f 100644
--- a/arducontrol/mfx.c
+++ b/arducontrol/mfx.c
@@ -429,7 +429,9 @@ uint8_t mfx_command(const uint8_t *cmd, uint8_t length)
 		uint8_t speed_dir = cmd[3];
 		if((speed_dir&0x7F)==0x7F)
 			return INVALID_VALUE;
-		++speed_dir;
+		// Skip emergency stop
+		if(speed_dir>0)
+			++speed_dir;
 
 		if(cmd[0]==MFX_SPEED)
 			mfx_speed_packet(addr, speed_dir);