Fixed most of the warnings that came with '-W all'

I have also edited the cg subroutine to remove if time step equals 1 condition in the main solve loop. not yet tested but should be good.