Add mavlink
Precise unit if not si in variable names for clarity