High contrast imaging from space must overcome photon noise of the diffracted star light and scattered light from optical components defects. The very high contrast required (up to $10^{-10}$ for terrestrial planets) puts severe requirements on the wavefront control system, as the achievable contrast is limited by the quality of the wavefront. In this paper we present a closed loop correction method for the shaped pupil coronagraph to minimize the energy in a pre-defined region in the image where terrestrial planets would be found. The reconstruction part uses three intensity measurements in the image plane with a pinhole added to the shaped pupil for diversity. This method has been shown in simulations to be effective in the presence of photon noise, deformable mirror modeling errors and overcoming defective actuators in the deformable mirror.