Address Paval's comments regarding extracting matrix from uavcan msg, position covariance calculation, and _poll_fds_num