[pos_history] Minor updates for pos_history test
[loco] Adds matlab script to study uncertainty mixing