cssp_camera: Fix it for small resolutions

This should make it work reliably for resolutions up to 1024x768

1280x960 and higher hang, or crash..