Move TrooperSonar to annpso.py