BP Merge

Adds Belief Propagation (Issue #61), MH fixes for referens (Issue #82) and registered map fix (Issue #83)