fixed make build issue for slam
belief and state versions work
added figures