Added state estimator part
temp
remote merging master
Merge branch 'master' of https://github.com/philipoe/ICRA2015_AtlantikSolar_Paper
merge state estimation part to master
Fix a small compilation error