#include <memory>
#include "S3315.h"
#include <cmath>
#include <cstring>
#include <iostream>
#include < iomanip >

/**
 * @brief
 *    根据密位返回角度
 *
 * @param mil        密位
 * @param mil_type   6000
 *
 * @return           返回当前密位对应的角度
 */
float calc_fov_by_mil(float mil, int mil_type)
{
    return (mil * 360.0f / mil_type);
}

void S3315GetImagePara(unsigned char* pParamDataBuffer, ARIDLL_INPUTPARA* ImagePara)
{
    ST_3315_152_NO110 pParamNO110DataBuffer = { 0 };
    ST_3315_152_NO149 pParamNO149DataBuffer = { 0 };
    //unsigned char* IR_para = { 0 };
    //memcpy(IR_para, pParamDataBuffer, 1280);
    //memcpy(&pParamNO110DataBuffer, pParamDataBuffer + 1280, 640);
   // memcpy(&pParamNO149DataBuffer, pParamDataBuffer + 1920, 640);
    //ImagePara->stServoInfo.fServoAz = calc_fov_by_mil(pParamNO149DataBuffer.B1B0,6000);
    //ImagePara->stServoInfo.fServoPt = calc_fov_by_mil(pParamNO149DataBuffer.B3B2,6000);
    //std::cout << std::hex << std::setw(8) << "pParamDataBuffer" << std::setfill('0') << reinterpret_cast<std::uintptr_t>(pParamDataBuffer) << ": " ;
    //for (int i = 0; i < 21; ++i)
    //{
    //    std::cout << std::hex << std::setw(4) << std::setfill('0') << static_cast<int>(pParamDataBuffer[i]) << " " ;
    //}
    //std::cout << std::endl;
    //int w = uint8_t(pParamDataBuffer[20]);
    //ImagePara->stServoInfo.fServoAz = pParamDataBuffer[258];
    //ImagePara->stServoInfo.fServoPt = pParamDataBuffer[259];
}