Add weights to the iterative filter
Add a cramer rao bound and fix the errors