Console Output

 增加打印与写入日志LOG 每次上船前初始化位姿