Removed debug printout
Compute leg positions, split merged legs
Removed extraneous line
Only plot measuredLoc
Fixed bug in plotting target pos
Plot leg circles
Make plot of tracks over time
Split line circle out of simlidar, fixed bug.
Implement leg model using fit to circles