forgot to add point-state-adolc
only last entry of each gradient is correct. possible decoupling when linearizing observation