EKF SLAM considers landmarks
Plus:
- message filter for slam to sync messages of odo and sensor
- crashes produce stack traces
- bugfix with slam pose publication

Known bug:
- slam prodces crap when robot orientation exceeds [-pi/2,pi/2]