Added smoother script that uses discrete RTS smoother
from 5.1 p337 in Crassidis

Improves estimate slightly, but not a whole lot. Not sure
if implementation is correct yet.