Added logging and forwarding for VICON data.

In addition to actually being in the logs, it is now also forwarded to mavlink.