sdu_pichi_surveyer: Added python scripts for loading route plans (not yet finished)