local_position plugin RPY not correct

[ggregory8]

@vooon
I've tested the vision_position and local_position plugins and they are working great thanks. Except the orientation(roll, pitch, yaw) of the transform that is published from local_position isn't changing as I move the FCU. I see the RPY change in the attitude message in QGC but the transform orientation doesn't change. I couldn't find this function:

https://github.com/vooon/mavros/blob/master/src/plugins/local_position.cpp#L104

[vooon]

I think somesing wrong in UAS attitude save (uas.cpp and imu_pub.cpp).

[ggregory8]

Thanks will test on Saturday