#include "Chunks.hpp"
#include "Chunk.hpp"
#include "voxel.hpp"
#include "Block.hpp"
#include "WorldGenerator.hpp"
#include "../content/Content.hpp"
#include "../lighting/Lightmap.hpp"
#include "../files/WorldFiles.hpp"
#include "../world/LevelEvents.hpp"
#include "../graphics/core/Mesh.hpp"
#include "../maths/voxmaths.hpp"
#include "../maths/aabb.hpp"
#include "../maths/rays.hpp"

#include <math.h>
#include <limits.h>
#include <vector>
#include <algorithm>

Chunks::Chunks(
    uint32_t w, uint32_t d, 
    int32_t ox, int32_t oz, 
    WorldFiles* wfile, 
    LevelEvents* events, 
    const Content* content
) : indices(content->getIndices()), 
    chunks(w*d),
    chunksSecond(w*d),
    w(w), d(d), ox(ox), oz(oz), 
    worldFiles(wfile), 
    events(events) 
{
    volume = static_cast<size_t>(w)*static_cast<size_t>(d);
    chunksCount = 0;
}

voxel* Chunks::get(int32_t x, int32_t y, int32_t z) const {
    x -= ox * CHUNK_W; 
    z -= oz * CHUNK_D;
    int cx = floordiv(x, CHUNK_W);
    int cy = floordiv(y, CHUNK_H);
    int cz = floordiv(z, CHUNK_D);
    if (cx < 0 || cy < 0 || cz < 0 || cx >= int(w) || cy >= 1 || cz >= int(d)) {
        return nullptr;
    }
    auto& chunk = chunks[cz * w + cx]; // not thread safe
    if (chunk == nullptr) {
        return nullptr;
    }
    int lx = x - cx * CHUNK_W;
    int ly = y - cy * CHUNK_H;
    int lz = z - cz * CHUNK_D;
    return &chunk->voxels[(ly * CHUNK_D + lz) * CHUNK_W + lx];
}

const AABB* Chunks::isObstacleAt(float x, float y, float z){
    int ix = floor(x);
    int iy = floor(y);
    int iz = floor(z);
    voxel* v = get(ix, iy, iz);
    if (v == nullptr) {
        if (iy >= CHUNK_H) {
            return nullptr;
        } else {
            static const AABB empty;
            return &empty;
        }
    }
    const auto def = indices->blocks.get(v->id);
    if (def->obstacle) {
        glm::ivec3 offset {};
        if (v->state.segment) {
            glm::ivec3 point(ix, iy, iz);
            offset = seekOrigin(point, def, v->state) - point;
        }
        const auto& boxes = def->rotatable 
                          ? def->rt.hitboxes[v->state.rotation] 
                          : def->hitboxes;
        for (const auto& hitbox : boxes) {
            if (hitbox.contains({x - ix - offset.x, y - iy - offset.y, z - iz - offset.z})) {
                return &hitbox;
            }
        }
    }
    return nullptr;
}

bool Chunks::isSolidBlock(int32_t x, int32_t y, int32_t z) {
    voxel* v = get(x, y, z);
    if (v == nullptr)
        return false;
    return indices->blocks.get(v->id)->rt.solid;
}

bool Chunks::isReplaceableBlock(int32_t x, int32_t y, int32_t z) {
    voxel* v = get(x, y, z);
    if (v == nullptr)
        return false;
    return indices->blocks.get(v->id)->replaceable;
}

bool Chunks::isObstacleBlock(int32_t x, int32_t y, int32_t z) {
    voxel* v = get(x, y, z);
    if (v == nullptr)
        return false;
    return indices->blocks.get(v->id)->obstacle;
}

ubyte Chunks::getLight(int32_t x, int32_t y, int32_t z, int channel){
    x -= ox * CHUNK_W;
    z -= oz * CHUNK_D;
    int cx = floordiv(x, CHUNK_W);
    int cy = floordiv(y, CHUNK_H);
    int cz = floordiv(z, CHUNK_D);
    if (cx < 0 || cy < 0 || cz < 0 || cx >= int(w) || cy >= 1 || cz >= int(d)) {
        return 0;
    }
    const auto& chunk = chunks[(cy * d + cz) * w + cx];
    if (chunk == nullptr) {
        return 0;
    }
    int lx = x - cx * CHUNK_W;
    int ly = y - cy * CHUNK_H;
    int lz = z - cz * CHUNK_D;
    return chunk->lightmap.get(lx, ly, lz, channel);
}

light_t Chunks::getLight(int32_t x, int32_t y, int32_t z){
    x -= ox * CHUNK_W;
    z -= oz * CHUNK_D;
    int cx = floordiv(x, CHUNK_W);
    int cy = floordiv(y, CHUNK_H);
    int cz = floordiv(z, CHUNK_D);
    if (cx < 0 || cy < 0 || cz < 0 || cx >= int(w) || cy >= 1 || cz >= int(d)) {
        return 0;
    }
    const auto& chunk = chunks[(cy * d + cz) * w + cx];
    if (chunk == nullptr) {
        return 0;
    }
    int lx = x - cx * CHUNK_W;
    int ly = y - cy * CHUNK_H;
    int lz = z - cz * CHUNK_D;
    return chunk->lightmap.get(lx,ly,lz);
}

Chunk* Chunks::getChunkByVoxel(int32_t x, int32_t y, int32_t z) {
    if (y < 0 || y >= CHUNK_H)
        return nullptr;
    x -= ox * CHUNK_W;
    z -= oz * CHUNK_D;
    int cx = floordiv(x, CHUNK_W);
    int cz = floordiv(z, CHUNK_D);
    if (cx < 0 || cz < 0 || cx >= int(w) || cz >= int(d))
        return nullptr;
    return chunks[cz * w + cx].get();
}

Chunk* Chunks::getChunk(int x, int z){
    x -= ox;
    z -= oz;
    if (x < 0 || z < 0 || x >= static_cast<int>(w) || z >= static_cast<int>(d)) {
        return nullptr;
    }
    return chunks[z * w + x].get();
}

glm::ivec3 Chunks::seekOrigin(glm::ivec3 pos, const Block* def, blockstate state) {
    const auto& rotation = def->rotations.variants[state.rotation];
    auto segment = state.segment;
    while (true) {
        if (!segment) {
            return pos;
        }
        if (segment & 1) pos -= rotation.axisX;
        if (segment & 2) pos -= rotation.axisY;
        if (segment & 4) pos -= rotation.axisZ;

        if (auto* voxel = get(pos.x, pos.y, pos.z)) {
            segment = voxel->state.segment;
        } else {
            return pos;
        }
    }
}

void Chunks::eraseSegments(const Block* def, blockstate state, int x, int y, int z) {
    const auto& rotation = def->rotations.variants[state.rotation];
    for (int sy = 0; sy < def->size.y; sy++) {
        for (int sz = 0; sz < def->size.z; sz++) {
            for (int sx = 0; sx < def->size.x; sx++) {
                if ((sx | sy | sz) == 0) {
                    continue;
                }
                glm::ivec3 pos(x, y, z);
                pos += rotation.axisX * sx;
                pos += rotation.axisY * sy;
                pos += rotation.axisZ * sz;
                set(pos.x, pos.y, pos.z, 0, {});
            }
        }
    }
}

static constexpr uint8_t segment_to_int(int sx, int sy, int sz) {
    return ((sx > 0) | ((sy > 0) << 1) | ((sz > 0) << 2));
}

void Chunks::repairSegments(const Block* def, blockstate state, int x, int y, int z) {
    const auto& rotation = def->rotations.variants[state.rotation];
    const auto id = def->rt.id;
    const auto size = def->size;
    for (int sy = 0; sy < size.y; sy++) {
        for (int sz = 0; sz < size.z; sz++) {
            for (int sx = 0; sx < size.x; sx++) {
                if ((sx | sy | sz) == 0) {
                    continue;
                }
                blockstate segState = state;
                segState.segment = segment_to_int(sx, sy, sz);

                glm::ivec3 pos(x, y, z);
                pos += rotation.axisX * sx;
                pos += rotation.axisY * sy;
                pos += rotation.axisZ * sz;
                set(pos.x, pos.y, pos.z, id, segState);
            }
        }
    }
}

bool Chunks::checkReplaceability(const Block* def, blockstate state, glm::ivec3 origin, blockid_t ignore) {
    const auto& rotation = def->rotations.variants[state.rotation];
    const auto size = def->size;
    for (int sy = 0; sy < size.y; sy++) {
        for (int sz = 0; sz < size.z; sz++) {
            for (int sx = 0; sx < size.x; sx++) {
                auto pos = origin;
                pos += rotation.axisX * sx;
                pos += rotation.axisY * sy;
                pos += rotation.axisZ * sz;
                if (auto vox = get(pos.x, pos.y, pos.z)) {
                    auto target = indices->blocks.get(vox->id);
                    if (!target->replaceable && vox->id != ignore) {
                        return false;
                    }
                } else {
                    return false;
                }
            }
        }
    }
    return true;
}

void Chunks::setRotationExtended(
    Block* def, blockstate state, glm::ivec3 origin, uint8_t index
) {
    auto newstate = state;
    newstate.rotation = index;
    
    // unable to rotate block (cause: obstacles)
    if (!checkReplaceability(def, newstate, origin, def->rt.id)) {
        return;
    }

    const auto& rotation = def->rotations.variants[index];
    const auto size = def->size;
    std::vector<glm::ivec3> segmentBlocks;

    for (int sy = 0; sy < size.y; sy++) {
        for (int sz = 0; sz < size.z; sz++) {
            for (int sx = 0; sx < size.x; sx++) {
                auto pos = origin;
                pos += rotation.axisX * sx;
                pos += rotation.axisY * sy;
                pos += rotation.axisZ * sz;

                blockstate segState = newstate;
                segState.segment = segment_to_int(sx, sy, sz);
                
                auto vox = get(pos);
                // checked for nullptr by checkReplaceability
                if (vox->id != def->rt.id) {
                    set(pos.x, pos.y, pos.z, def->rt.id, segState);
                } else {
                    vox->state = segState;
                    auto chunk = getChunkByVoxel(pos.x, pos.y, pos.z);
                    chunk->setModifiedAndUnsaved();
                    segmentBlocks.emplace_back(pos);
                }
            }
        }
    }
    const auto& prevRotation = def->rotations.variants[state.rotation];
    for (int sy = 0; sy < size.y; sy++) {
        for (int sz = 0; sz < size.z; sz++) {
            for (int sx = 0; sx < size.x; sx++) {
                auto pos = origin;
                pos += prevRotation.axisX * sx;
                pos += prevRotation.axisY * sy;
                pos += prevRotation.axisZ * sz;
                if (std::find(segmentBlocks.begin(), segmentBlocks.end(), pos) == segmentBlocks.end()) {
                    set(pos.x, pos.y, pos.z, 0, {});
                }
            }
        }
    }
}

void Chunks::setRotation(int32_t x, int32_t y, int32_t z, uint8_t index) {
    if (index >= BlockRotProfile::MAX_COUNT) {
        return;
    }
    auto vox = get(x, y, z);
    if (vox == nullptr) {
        return;
    }
    auto def = indices->blocks.get(vox->id);
    if (!def->rotatable || vox->state.rotation == index) {
        return;
    }
    if (def->rt.extended) {
        setRotationExtended(def, vox->state, {x, y, z}, index);
    } else {
        vox->state.rotation = index;
        auto chunk = getChunkByVoxel(x, y, z);
        chunk->setModifiedAndUnsaved();   
    }
}

void Chunks::set(int32_t x, int32_t y, int32_t z, uint32_t id, blockstate state) {
    if (y < 0 || y >= CHUNK_H) {
        return;
    }
    int32_t gx = x;
    int32_t gz = z;
    x -= ox * CHUNK_W;
    z -= oz * CHUNK_D;
    int cx = floordiv(x, CHUNK_W);
    int cz = floordiv(z, CHUNK_D);
    if (cx < 0 || cz < 0 || cx >= static_cast<int>(w) || cz >= static_cast<int>(d)) {
        return;
    }
    Chunk* chunk = chunks[cz * w + cx].get();
    if (chunk == nullptr) {
        return;
    }
    int lx = x - cx * CHUNK_W;
    int lz = z - cz * CHUNK_D;
    
    // block finalization
    voxel& vox = chunk->voxels[(y * CHUNK_D + lz) * CHUNK_W + lx]; 
    auto prevdef = indices->blocks.get(vox.id);
    if (prevdef->inventorySize == 0) {
        chunk->removeBlockInventory(lx, y, lz);
    }
    if (prevdef->rt.extended && !vox.state.segment) {
        eraseSegments(prevdef, vox.state, gx, y, gz);
    }

    // block initialization
    auto newdef = indices->blocks.get(id);
    vox.id = id;
    vox.state = state;
    chunk->setModifiedAndUnsaved();
    if (!state.segment && newdef->rt.extended) {
        repairSegments(newdef, state, gx, y, gz);
    }

    if (y < chunk->bottom) chunk->bottom = y;
    else if (y + 1 > chunk->top) chunk->top = y + 1;
    else if (id == 0) chunk->updateHeights();

    if (lx == 0 && (chunk = getChunk(cx+ox-1, cz+oz)))
        chunk->flags.modified = true;
    if (lz == 0 && (chunk = getChunk(cx+ox, cz+oz-1))) 
        chunk->flags.modified = true;

    if (lx == CHUNK_W-1 && (chunk = getChunk(cx+ox+1, cz+oz))) 
        chunk->flags.modified = true;
    if (lz == CHUNK_D-1 && (chunk = getChunk(cx+ox, cz+oz+1))) 
        chunk->flags.modified = true;
}

voxel* Chunks::rayCast(
    glm::vec3 start, 
    glm::vec3 dir, 
    float maxDist, 
    glm::vec3& end, 
    glm::ivec3& norm, 
    glm::ivec3& iend
) {
    float px = start.x;
    float py = start.y;
    float pz = start.z;

    float dx = dir.x;
    float dy = dir.y;
    float dz = dir.z;

    float t = 0.0f;
    int ix = floor(px);
    int iy = floor(py);
    int iz = floor(pz);

    int stepx = (dx > 0.0f) ? 1 : -1;
    int stepy = (dy > 0.0f) ? 1 : -1;
    int stepz = (dz > 0.0f) ? 1 : -1;

    constexpr float infinity = std::numeric_limits<float>::infinity();

    float txDelta = (dx == 0.0f) ? infinity : abs(1.0f / dx);
    float tyDelta = (dy == 0.0f) ? infinity : abs(1.0f / dy);
    float tzDelta = (dz == 0.0f) ? infinity : abs(1.0f / dz);

    float xdist = (stepx > 0) ? (ix + 1 - px) : (px - ix);
    float ydist = (stepy > 0) ? (iy + 1 - py) : (py - iy);
    float zdist = (stepz > 0) ? (iz + 1 - pz) : (pz - iz);

    float txMax = (txDelta < infinity) ? txDelta * xdist : infinity;
    float tyMax = (tyDelta < infinity) ? tyDelta * ydist : infinity;
    float tzMax = (tzDelta < infinity) ? tzDelta * zdist : infinity;

    int steppedIndex = -1;      
                                
    while (t <= maxDist){       
        voxel* voxel = get(ix, iy, iz);		
        if (voxel == nullptr){
            return nullptr;
        }
        const auto def = indices->blocks.get(voxel->id);
        if (def->selectable){
            end.x = px + t * dx;
            end.y = py + t * dy;
            end.z = pz + t * dz;
            iend.x = ix;
            iend.y = iy;
            iend.z = iz;
            
            if (!def->rt.solid) {
                const std::vector<AABB>& hitboxes = def->rotatable
                        ? def->rt.hitboxes[voxel->state.rotation]
                        : def->hitboxes;

                scalar_t distance = maxDist;
                Ray ray(start, dir);

                bool hit = false;

                glm::vec3 offset {};
                if (voxel->state.segment) {
                    offset = seekOrigin(iend, def, voxel->state) - iend;
                }

                for (auto box : hitboxes) {
                    box.a += offset;
                    box.b += offset;
                    scalar_t boxDistance;
                    glm::ivec3 boxNorm;
                    if (ray.intersectAABB(iend, box, maxDist, boxNorm, boxDistance) > RayRelation::None && boxDistance < distance) {
                        hit = true;
                        distance = boxDistance;
                        norm = boxNorm;
                        end = start + (dir * glm::vec3(distance));
                    }
                }

                if (hit) return voxel;
            } else {
                iend.x = ix;
                iend.y = iy;
                iend.z = iz;

                norm.x = norm.y = norm.z = 0;
                if (steppedIndex == 0) norm.x = -stepx;
                if (steppedIndex == 1) norm.y = -stepy;
                if (steppedIndex == 2) norm.z = -stepz;
                return voxel;
            }
        }
        if (txMax < tyMax) {
            if (txMax < tzMax) {
                ix += stepx;
                t = txMax;
                txMax += txDelta;
                steppedIndex = 0;
            } else {
                iz += stepz;
                t = tzMax;
                tzMax += tzDelta;
                steppedIndex = 2;
            }
        } else {
            if (tyMax < tzMax) {
                iy += stepy;
                t = tyMax;
                tyMax += tyDelta;
                steppedIndex = 1;
            } else {
                iz += stepz;
                t = tzMax;
                tzMax += tzDelta;
                steppedIndex = 2;
            }
        }
    }
    iend.x = ix;
    iend.y = iy;
    iend.z = iz;

    end.x = px + t * dx;
    end.y = py + t * dy;
    end.z = pz + t * dz;
    norm.x = norm.y = norm.z = 0;
    return nullptr;
}

glm::vec3 Chunks::rayCastToObstacle(glm::vec3 start, glm::vec3 dir, float maxDist) {
    float px = start.x;
    float py = start.y;
    float pz = start.z;

    float dx = dir.x;
    float dy = dir.y;
    float dz = dir.z;

    float t = 0.0f;
    int ix = floor(px);
    int iy = floor(py);
    int iz = floor(pz);

    int stepx = (dx > 0.0f) ? 1 : -1;
    int stepy = (dy > 0.0f) ? 1 : -1;
    int stepz = (dz > 0.0f) ? 1 : -1;

    constexpr float infinity = std::numeric_limits<float>::infinity();

    float txDelta = (dx == 0.0f) ? infinity : abs(1.0f / dx);
    float tyDelta = (dy == 0.0f) ? infinity : abs(1.0f / dy);
    float tzDelta = (dz == 0.0f) ? infinity : abs(1.0f / dz);

    float xdist = (stepx > 0) ? (ix + 1 - px) : (px - ix);
    float ydist = (stepy > 0) ? (iy + 1 - py) : (py - iy);
    float zdist = (stepz > 0) ? (iz + 1 - pz) : (pz - iz);

    float txMax = (txDelta < infinity) ? txDelta * xdist : infinity;
    float tyMax = (tyDelta < infinity) ? tyDelta * ydist : infinity;
    float tzMax = (tzDelta < infinity) ? tzDelta * zdist : infinity;

    while (t <= maxDist) {
        voxel* voxel = get(ix, iy, iz);
        if (voxel == nullptr) { 
            return glm::vec3(px + t * dx, py + t * dy, pz + t * dz); 
        }
        const auto def = indices->blocks.get(voxel->id);
        if (def->obstacle) {
            if (!def->rt.solid) {
                const std::vector<AABB>& hitboxes = def->rotatable
                    ? def->rt.hitboxes[voxel->state.rotation]
                    : def->modelBoxes;

                scalar_t distance;
                glm::ivec3 norm;
                Ray ray(start, dir);

                glm::ivec3 offset {};
                if (voxel->state.segment) {
                    offset = seekOrigin({ix, iy, iz}, def, voxel->state) - glm::ivec3(ix, iy, iz);
                }

                for (const auto& box : hitboxes) {
                    // norm is dummy now, can be inefficient
                    if (ray.intersectAABB(glm::ivec3(ix, iy, iz)+offset, box, maxDist, norm, distance) > RayRelation::None) {
                        return start + (dir * glm::vec3(distance));
                    }
                }
            }
            else {
                return glm::vec3(px + t * dx, py + t * dy, pz + t * dz);
            }
        }
        if (txMax < tyMax) {
            if (txMax < tzMax) {
                ix += stepx;
                t = txMax;
                txMax += txDelta;
            }
            else {
                iz += stepz;
                t = tzMax;
                tzMax += tzDelta;
            }
        }
        else {
            if (tyMax < tzMax) {
                iy += stepy;
                t = tyMax;
                tyMax += tyDelta;
            }
            else {
                iz += stepz;
                t = tzMax;
                tzMax += tzDelta;
            }
        }
    }
    return glm::vec3(px + maxDist * dx, py + maxDist * dy, pz + maxDist * dz);
}


void Chunks::setCenter(int32_t x, int32_t z) {
    int cx = floordiv(x, CHUNK_W);
    int cz = floordiv(z, CHUNK_D);
    cx -= ox + w / 2;
    cz -= oz + d / 2;
    if (cx | cz) {
        translate(cx,cz);
    }
}

void Chunks::translate(int32_t dx, int32_t dz) {
    auto& regions = worldFiles->getRegions();
    for (uint i = 0; i < volume; i++){
        chunksSecond[i] = nullptr;
    }
    for (uint32_t z = 0; z < d; z++) {
        for (uint32_t x = 0; x < w; x++) {
            auto chunk = chunks[z * w + x];
            int nx = x - dx;
            int nz = z - dz;
            if (chunk == nullptr)
                continue;
            if (nx < 0 || nz < 0 || nx >= int(w) || nz >= int(d)) {
                events->trigger(EVT_CHUNK_HIDDEN, chunk.get());
                regions.put(chunk.get());
                chunksCount--;
                continue;
            }
            chunksSecond[nz * w + nx] = chunk;
        }
    }
    std::swap(chunks, chunksSecond);

    ox += dx;
    oz += dz;
}

void Chunks::resize(uint32_t newW, uint32_t newD) {
    if (newW < w) {
        int delta = w - newW;
        translate(delta / 2, 0);
        translate(-delta, 0);
        translate(delta, 0);
    }
    if (newD < d) {
        int delta = d - newD;
        translate(0, delta / 2);
        translate(0, -delta);
        translate(0, delta);
    }
    const int newVolume = newW * newD;
    std::vector<std::shared_ptr<Chunk>> newChunks(newVolume);
    std::vector<std::shared_ptr<Chunk>> newChunksSecond(newVolume);
    for (int z = 0; z < int(d) && z < int(newD); z++) {
        for (int x = 0; x < int(w) && x < int(newW); x++) {
            newChunks[z * newW + x] = chunks[z * w + x];
        }
    }
    w = newW;
    d = newD;
    volume = newVolume;
    chunks = std::move(newChunks);
    chunksSecond = std::move(newChunksSecond);
}

void Chunks::_setOffset(int32_t x, int32_t z) {
    ox = x;
    oz = z;
}

bool Chunks::putChunk(const std::shared_ptr<Chunk>& chunk) {
    int x = chunk->x;
    int z = chunk->z;
    x -= ox;
    z -= oz;
    if (x < 0 || z < 0 || x >= int(w) || z >= int(d))
        return false;
    chunks[z * w + x] = chunk;
    chunksCount++;
    return true;
}

void Chunks::saveAndClear(){
    auto& regions = worldFiles->getRegions();
    for (size_t i = 0; i < volume; i++){
        Chunk* chunk = chunks[i].get();
        chunks[i] = nullptr;
        if (chunk) {
            regions.put(chunk);
        }
    }
    chunksCount = 0;
}