LTV filter/smoother testcase working