@cy208183395 Can you test this with SITL? Does it work fine there but not on VOXL 2?