get continuous trajectory as output, still diverge with the dynamic filter