Use Vec3 utility to replace rough array, add utility function for Node and Vec3 class