Using Path Finding/smoothing in an XNA project