#include <features.h>
#include <communication/webserver.h>

namespace feature_service {

void printFeatureConfiguration() {
    ESP_LOGI("Features", "====================== FEATURE FLAGS ======================");
    ESP_LOGI("Features", "Firmware version: %s, name: %s, target: %s", APP_VERSION, APP_NAME, BUILD_TARGET);

    ESP_LOGI("Features", "USE_CAMERA: %s", USE_CAMERA ? "enabled" : "disabled");
    ESP_LOGI("Features", "USE_MOTION: %s", USE_MOTION ? "enabled" : "disabled");

    ESP_LOGI("Features", "USE_BNO055: %s", USE_BNO055 ? "enabled" : "disabled");
    ESP_LOGI("Features", "USE_MPU6050: %s", USE_MPU6050 ? "enabled" : "disabled");
    ESP_LOGI("Features", "USE_HMC5883: %s", USE_HMC5883 ? "enabled" : "disabled");
    ESP_LOGI("Features", "USE_BMP180: %s", USE_BMP180 ? "enabled" : "disabled");
    ESP_LOGI("Features", "USE_USS: %s", USE_USS ? "enabled" : "disabled");

    ESP_LOGI("Features", "USE_PCA9685: %s", USE_PCA9685 ? "enabled" : "disabled");
    ESP_LOGI("Features", "USE_WS2812: %s", USE_WS2812 ? "enabled" : "disabled");

    ESP_LOGI("Features", "USE_MDNS: %s", USE_MDNS ? "enabled" : "disabled");
    ESP_LOGI("Features", "EMBED_WEBAPP: %s", EMBED_WEBAPP ? "enabled" : "disabled");
    ESP_LOGI("Features", "KINEMATICS_VARIANT: %s", KINEMATICS_VARIANT_STR);
    ESP_LOGI("Features", "==========================================================");
}

void features_request(const socket_message_FeaturesDataRequest& fd_req, socket_message_FeaturesDataResponse& fd_res) {
    fd_res.camera = USE_CAMERA ? true : false;
    fd_res.imu = (USE_MPU6050 || USE_BNO055) ? true : false;
    fd_res.mag = (USE_HMC5883 || USE_BNO055) ? true : false;
    fd_res.bmp = USE_BMP180 ? true : false;
    fd_res.sonar = USE_USS ? true : false;
    fd_res.servo = USE_PCA9685 ? true : false;
    fd_res.ws2812 = USE_WS2812 ? true : false;
    fd_res.mdns = USE_MDNS ? true : false;
    fd_res.embed_www = EMBED_WEBAPP ? true : false;
    fd_res.firmware_version = const_cast<char*>(APP_VERSION);
    fd_res.firmware_name = const_cast<char*>(APP_NAME);
    fd_res.firmware_built_target = const_cast<char*>(BUILD_TARGET);
    fd_res.variant = const_cast<char*>(KINEMATICS_VARIANT_STR);
}


} // namespace feature_service