停止時にstop関数をループさせずに、stop_flagを利用して1度だけi2c書き込みをMDに行うようにした。i2cのデータがスタックするのを防止する為(ちなみにi2cをフルで使用した際の周期は2.4[ms]であった)。

Dependencies:   mbed QEI PID