L1代码请教，代码是PX4的rover

请问，偏航角和航线角度设置在5度，代码该怎么去写呢，想去跑小车的MISSION模式