media: mx6 camera: S_FMT needs to retrieve the correct format

S_FMT needs to get the new pixelformat and set the correct image size.
media: imx6 camera: Second step to a vb2 compatible driver

This time, initialize vb2 queue in probe and use core functions