Function GridTest

Source/Objects/movementobject.cpp:679–857

}

void GridTest(vec3 pos, BulletWorld* bw, float _leg_sphere_size) {
    if (grid_cells.empty()) {
        grid_cells.resize(_grid_size * _grid_size * _grid_size);
    }
    int index = 0;
    for (int i = 0; i < _grid_size; ++i) {
        for (int j = 0; j < _grid_size; ++j) {
            for (int k = 0; k < _grid_size; ++k) {
                vec3 quantized_pos = vec3(floor(pos[0] / cell_size), floor(pos[1] / cell_size), floor(pos[2] / cell_size)) * cell_size;
                quantized_pos[0] += (i - (_grid_size / 2)) * cell_size;
                quantized_pos[1] += (j - (_grid_size / 2)) * cell_size;
                quantized_pos[2] += (k - (_grid_size / 2)) * cell_size;
                ContactSlideCallback cb;
                cb.single_sided = false;
                bw->GetSphereCollisions(quantized_pos, _leg_sphere_size, cb);
                if (cb.collision_info.contacts.size() == 0) {
                    grid_cells[index].solid = false;
                } else {
                    grid_cells[index].solid = true;
                }
                grid_cells[index].walkable = false;
                grid_cells[index].boundary = false;
                ++index;
            }
        }
    }

    for (int i = 0; i < _grid_size; ++i) {
        for (int j = 0; j < _grid_size; ++j) {
            for (int k = 0; k < _grid_size; ++k) {
                if (!grid_cells[GridIndexFromCoord(i, j, k)].solid) {
                    bool next_to_solid = false;
                    if (i != 0 && grid_cells[GridIndexFromCoord(i - 1, j, k)].solid == true) {
                        next_to_solid = true;
                    } else if (i != _grid_size - 1 && grid_cells[GridIndexFromCoord(i + 1, j, k)].solid == true) {
                        next_to_solid = true;
                    } else if (k != 0 && grid_cells[GridIndexFromCoord(i, j, k - 1)].solid == true) {
                        next_to_solid = true;
                    } else if (k != _grid_size - 1 && grid_cells[GridIndexFromCoord(i, j, k + 1)].solid == true) {
                        next_to_solid = true;
                    } else if (j != 0 && grid_cells[GridIndexFromCoord(i, j - 1, k)].solid == true) {
                        next_to_solid = true;
                    } else if (j != _grid_size - 1 && grid_cells[GridIndexFromCoord(i, j + 1, k)].solid == true) {
                        next_to_solid = true;
                    }
                    if (next_to_solid) {
                        grid_cells[GridIndexFromCoord(i, j, k)].boundary = true;
                        vec3 quantized_pos = vec3(floor(pos[0] / cell_size), floor(pos[1] / cell_size), floor(pos[2] / cell_size)) * cell_size;
                        quantized_pos[0] += (i - (_grid_size / 2)) * cell_size;
                        quantized_pos[1] += (j - (_grid_size / 2)) * cell_size;
                        quantized_pos[2] += (k - (_grid_size / 2)) * cell_size;
                        DebugDraw::Instance()->AddWireSphere(quantized_pos, 0.1f, vec4(vec3(0.0f, 1.0f, 0.0f), 0.2f), _delete_on_update);
                    }
                }
            }
        }
    }