PX4官方手册给的 Auterion 的VIO功能包（用于PX4 T265定点）的代码可以分析一下，感觉写的比vision_to_mavros简单一些