Sketched Todd's position estimation algorithm

I think I have a handle on what's going on now ... I'm going
to leave the stable manual_position_estimation.py as is and
make my changes to to position_est.