Added linear interpolation focus finder base.
Cleaned up focus finder code base.