#include <firmware_upload_service.h>
#include <esp_app_format.h>
#include <esp_ota_ops.h>

static const char *TAG = "FirmwareUploadService";

using namespace std::placeholders;

static char md5[33] = "\0";
static size_t fsize = 0;

static FileType fileType = ft_none;

FirmwareUploadService::FirmwareUploadService() {}

void FirmwareUploadService::begin() {
    uploadHandler.onUpload(std::bind(&FirmwareUploadService::handleUpload, this, _1, _2, _3, _4, _5, _6));
    uploadHandler.onRequest(std::bind(&FirmwareUploadService::uploadComplete, this, _1));
    uploadHandler.onClose(std::bind(&FirmwareUploadService::handleEarlyDisconnect, this));
}

esp_err_t FirmwareUploadService::handleUpload(PsychicRequest *request, const String &filename, uint64_t index,
                                              uint8_t *data, size_t len, bool final) {
    // at init
    if (!index) {
        // check details of the file, to see if its a valid bin or json file
        std::string fname(filename.c_str());
        auto position = fname.find_last_of(".");
        std::string extension = fname.substr(position + 1);
        fsize = request->contentLength();

        fileType = ft_none;
        if ((extension == "bin") && (fsize > 1000000)) {
            fileType = ft_firmware;
        } else if (extension == "md5") {
            fileType = ft_md5;
            if (len == 32) {
                memcpy(md5, data, 32);
                md5[32] = '\0';
            }
            return ESP_OK;
        } else {
            md5[0] = '\0';
            return handleError(request,
                               406); // Not Acceptable - unsupported file type
        }

        if (fileType == ft_firmware) {
            // Check firmware header, 0xE9 magic offset 0 indicates esp bin, chip
            // offset 12: esp32:0, S2:2, C3:5
#if CONFIG_IDF_TARGET_ESP32 // ESP32/PICO-D4
            if (len > 12 && (data[0] != 0xE9 || data[12] != 0)) {
                return handleError(request, 503); // service unavailable
            }
#elif CONFIG_IDF_TARGET_ESP32S2
            if (len > 12 && (data[0] != 0xE9 || data[12] != 2)) {
                return handleError(request, 503); // service unavailable
            }
#elif CONFIG_IDF_TARGET_ESP32C3
            if (len > 12 && (data[0] != 0xE9 || data[12] != 5)) {
                return handleError(request, 503); // service unavailable
            }
#elif CONFIG_IDF_TARGET_ESP32S3
            if (len > 12 && (data[0] != 0xE9 || data[12] != 9)) {
                return handleError(request, 503); // service unavailable
            }
#endif
            // it's firmware - initialize the ArduinoOTA updater
            if (Update.begin(fsize - sizeof(esp_image_header_t))) {
                ESP_LOGI(TAG, "Starting update");
                if (strlen(md5) == 32) {
                    Update.setMD5(md5);
                    md5[0] = '\0';
                    ESP_LOGI(TAG, "Setting MD5 hash");
                }
            } else {
                return handleError(request, 507); // failed to begin, send an error
                                                  // response Insufficient Storage
            }
        }
    }

    // if we haven't delt with an error, continue with the firmware update
    if (!request->_tempObject) {
        if (Update.write(data, len) != len) {
            handleError(request, 500);
        } else {
            JsonVariant obj;
            obj["status"] = "progress";
            obj["progress"] = (float)Update.progress() / (float)fsize * 100.f;
            socket.emit("otastatus", obj);
            delay(20);
        }
        if (final) {
            if (!Update.end(true)) {
                handleError(request, 500);
            } else {
                JsonVariant obj;
                obj["status"] = "finished", obj["progress"] = 100;
                socket.emit("otastatus", obj);
                ESP_LOGI(TAG, "Finish writing update");
            }
        }
    }

    return ESP_OK;
}

esp_err_t FirmwareUploadService::uploadComplete(PsychicRequest *request) {
    // if we completed uploading a md5 file create a JSON response
    if (fileType == ft_md5) {
        if (strlen(md5) == 32) {
            PsychicJsonResponse response = PsychicJsonResponse(request, false);
            JsonObject root = response.getRoot();
            root["md5"] = md5;
            return response.send();
        }
        return ESP_OK;
    }

    // if no error, send the success response
    if (!request->_tempObject) {
        ESP_LOGI(TAG, "Finish updating");
        system_service::restart();
        return ESP_OK;
    }

    // if updated has an error send 500 response and log on Serial
    if (Update.hasError()) {
        Update.printError(Serial);
        Update.abort();
        handleError(request, 500);
    }

    return ESP_OK;
}

esp_err_t FirmwareUploadService::handleError(PsychicRequest *request, int code) {
    JsonVariant obj;
    obj["status"] = "error", obj["error"] = Update.getError();
    socket.emit("otastatus", obj);
    // if we have had an error already, do nothing
    if (request->_tempObject) {
        return ESP_OK;
    }

    // send the error code to the client and record the error code in the temp
    // object
    request->_tempObject = new int(code);
    return request->reply(code);
}

esp_err_t FirmwareUploadService::handleEarlyDisconnect() {
    // if updated has not ended on connection close, abort it
    if (!Update.end(true)) {
        Update.printError(Serial);
        Update.abort();
        return ESP_OK;
    }
    return ESP_OK;
}