New Simulation Code

Got rid of extraneous stuff from Park algorithm and simplified/commented
the functions better. Feel free to try to break it. This model doesn't
account for wind, but does include Gaussian noise on position
measurements into Frew algorithm.