Modbus scan rate accuracy improved: timer is incremented according to current-old time delta. Current time is acquired with rt_timer_read().