ffs.s diff

diff --git a/firmware/asm/arm/ffs.S b/firmware/asm/arm/ffs.S
index 4e912c5..3bc73f6 100644
--- a/firmware/asm/arm/ffs.S
+++ b/firmware/asm/arm/ffs.S
@@ -32,6 +32,11 @@
  *   31 - bit 31 is set
  *   32 - no bits set
  ****************************************************************************/
+#if  (ARCH_PROFILE == arch_profile_m)
+    .syntax unified
+    .thumb
+#endif //(ARCH_PROFILE == arch_profile_m)
+
     .align  2
     .global find_first_set_bit
     .type   find_first_set_bit,%function
@@ -44,6 +49,9 @@ find_first_set_bit:

 #if ARM_ARCH >= 5
     clz     r0, r1                   @ Get lead 0's count
+#if  (ARCH_PROFILE == arch_profile_m)
+    it      ne
+#endif //(ARCH_PROFILE == arch_profile_m)
     rsbne   r0, r0, #31              @ lead 0's -> bit index
     bx      lr                       @
 #else