Allow setting initial state of Kalman filter

Johannes Pfeiferrequested to merge
JohannesPfeifer:filter_initial_state into master

Related to #1409 (closed) and #1395

Edited by Sébastien Villemot

Merge request reports