Fix velx/y mixup, add diagnostic publisher.