Sdlog2: add vision estimation logging

It allows the log of X,Y,Z,VX,VY,VZ and quaternions. Regarding vx,vy,vz, need to add handler for VISION_SPEED_ESTIMATE.