added bhv algorithm. Still need to find closest triangle to return ip from