msm: camera: fix testgen and camif config

With testgen, the pixel will sitll go through CAMIF.
We still need to config Camif.
Besides, camif GO and testgen GO program at wrong timing.
it should be only program at the last step

Change-Id: I2eb0c5a04227d9e03b8358bdbb2971b82c161bd4
Signed-off-by: Peter Liu <pingchie@codeaurora.org>