Merged/Modifed Scripts with Alex's version, need to figure out some problems regarding SetTask in navAgent