Problem is now solved. It was because the timestamps of the velocity msg was not being set whereas the attitude message did have an up to date timestamp. So if you come across something similar check that all timestamps have been set correctly in sent messages.
1 Like