msm: camera: Fix based on stock camera - Thanks to faust93