du hast ein klassische frequenz von 50hz, das heißt man könnte das timeout auf 2 perioden legen. das wären dann maximal 40ms, ich muß mir das noch mal anschaun.
ein servo für Sensoren habe ich nicht, nur lenkung und esc.