CasADi files for 6-dof arm
beginning of slam code
Merge branch 'master' of https://github.com/gkahn13/bsp
Merge branch 'gkahn'
Merge branch 'gkahn'
Merge branch 'gkahn'
CasADi files updated for arm,point
added helper functions to arm-belief.cpp