Least square image matching

I am working on image matching. I've found the keypoint locations (x,y) in pair images and wish to go for sub-pixel location refinement. Generally least squares is used for it. Can you please provide me the code of basic least squares image matching.

I've heard that for use of least squares...its a nonlinear problem which is initially linearized by Taylor expansion and then solved. Please help me over it.