1. Fixed issue where covariance of sampled FIRM node was not being saved in graph.

2. Added Graph to XML function in FIRM utils and corresponding in FIRM planner.