Hi,
About the mt9p001 you need to do porting yourself. The default BSP supports OV5640 camera sensor on the i.MX6Q. Here you can refer to the OV5640. You also can refer to this thread OV5645 Driver . Hope this can do help for you.
Have a nice day
Rita