emit roll, pitch and yaw setpoints for plotting

With the recent change in mavlink to the attitude_target message the attitude setpoint is sent as a quaternion. However, most people can intuitively understand roll, pitch and yaw values better. This PR makes the rpy values corresponding to the quaternion appear in the plot.