Almost finished with waypathing algorithm. Need to make towards move the npc in an actually straight line