mcdonald changes
fixed the normalization bug
Merge branch 'master' of /home/autolab/git-repo/PelicanCtrl
PositionVis changes for position estimation