Pathing2

The movement is still a little jumpy, but the pathing is working