Testing de-coupled updates
R converges but wtf t diverges? Try iterate ekf?