Fixed Bug with small circle tracking; Outlier Rejection; Better joint initialization; Correct sigma calculation; Radius-correlated noise estimates.