add chThdSleepMicroseconds() but still not working #33