1. MMPolicyGenerator: Fixed the removeBelief function, it was incorrectly implemented, moved Macros to static variables

2. CamArucoObservationModel:  Added assert conditions for likelihood weight > 0. Apparently, if mode is on top (too close to landmark), weight  goes to -nan.