add jacobi_polar
wip: EKF nearly done, working on helper functions, next is calculating jacobian
add jacobi_polar.c
Merge branch 'team'
update TODO
update TODO
remove old tree code, comment out ekf update for now
rename landmark_tree->landmark_map
rename landmark_map_node->landmark_map
a few other naming cleanups, fix build
Merge branch 'team'