feat: Added filtering

Refactored flight controller code