From ac6b4567d1dbebd629da044c16e1813fa1e0fa38 Mon Sep 17 00:00:00 2001 From: Mathias Rasmussen Date: Thu, 10 Sep 2020 02:26:32 +0200 Subject: [PATCH] perf: Reduce DShot invert code --- BLHeli_S.asm | 14 ++++---------- 1 file changed, 4 insertions(+), 10 deletions(-) diff --git a/BLHeli_S.asm b/BLHeli_S.asm index 55e5930..e4c8a17 100644 --- a/BLHeli_S.asm +++ b/BLHeli_S.asm @@ -557,22 +557,16 @@ t1_int_decode_checksum: anl A, #0Fh jnz t1_int_decode_fail ; XOR check - ; Invert DShot data - mov A, Temp4 - cpl A - anl A, #0Fh - mov Temp4, A - mov A, Temp3 - cpl A - mov Temp3, A - - ; Subtract 96 (still 12 bits) + ; Invert DShot data and subtract 96 (still 12 bits) clr C mov A, Temp3 + cpl A mov Temp2, A subb A, #96 mov Temp3, A mov A, Temp4 + cpl A + anl A, #0Fh subb A, #0 mov Temp4, A jnc t1_normal_range