Replace Mathutils Vector with Custom Vector3 Class

[KcRobin9]

The Blender Waypoint Functions have been designed with Vector from Mathutils, but this library is notoriously difficult to install outside Blender. So use existing Vector3 functions or implement new ones to replace the current Mathutils Vector present in the functions.