Easier pose computation in filter.
Minor indentation and newline fixes.