Working on lerp and pathing