Create wp_manipulation.py

Added wp_manipulation module
Create wp_manipulation.py
Revert "Create wp_manipulation.py"

This reverts commit dee12aeed36c07e55cab6cf1a0ef12fab09a710e.
Merge remote-tracking branch 'origin/command-changes' into waypoint_manipulation
Merge remote-tracking branch 'origin/command-changes' into waypoint_manipulation
changed print function to print lat lon
Added waypoint upload and auto set (works)
Fixed last commit
Added wp_manipulation