1. Integrated mmpolicygen into FIRM, can recover from lost state and go to goal.
2. Now need to fix, kidnapped state detection.