Still working on new kalman/ss forms