Commited also the c routine

On static image, writing colour png
Updated static stereo for correlation too