added wp_manipulation.py
Added wp_manipulation
Fixed the print
Stop printing "not loading waypoints"