1. Fixed bug in observationmodel xml reader that set noise in bearing obs to extremely high value
2. Fixed issue where innovation was not correctly calculated if predicted observation had more values than ground in policygenerator.