Edit to copy, ico files in but not linked
Added waypoints library and added simple function to test it out. Not working properly yet