Attempt at linear interpolation. Also speedup SPC700 a bit by simplifying timer handling.