Cosmetic change.
Properly initialize and deallocate planner class attributes.
Apply only one ZMP filtering stage.