Now A* Pathfinding integrated, and character locomotion system using Mecanim system. This took a lot of value tweaking to get movement to orient towards the waypoints, to improve it I think sharper turn animations are needed.