// ActuatorDemo.cpp : 此文件包含 "main" 函数。程序执行将在此处开始并结束。
//

#include <iostream>
#include <thread>
#include <windows.h>
#include "../Actuator//Actuator.h"

/******************* 为PLC自动监测准备相关全部变量******************************** */
static bool plcScan = true;
static bool devRunning = false;
/*************************************************************************************
**************************************************************************************/


//系数
const double coef[5] = { -6.204673384923,0.025161776479,-0.000014765722,0.000000003440,0 };
const char sPortName[] = "COM6";

//手动写粮食品种
void ManReady()
{
    if (devRunning){printf("水分仪忙!"); return;}

    devRunning = true;
    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);
    if (hWrDev)
    {
         int ret = ConnectDevice(hWrDev);

         if (ret >= 0)
         {

             ret = SendCommands(hWrDev, WR_READY, 0x01, 0, 500000); //下发确认

             if (ret <= 0)
                 printf("准备失败！\n");
             else
             {
                 printf("准备就绪，OK！\n");
             }
         }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}

//手动检测
void ManTest()
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);
    if (hWrDev)
    {
        int ret = ConnectDevice(hWrDev);

        if (ret >= 0)
        {
            ret = SendCommands(hWrDev, WR_DETECT, 0, 60, 0); //执行启动命令

            if (ret <= 0)
            {
                printf("执行检测失败！\n");
            }
            else
            {
                unsigned short nDatas[10] = { 0 };

                //从水分仪器读取数据
                ret = ReadDatas(hWrDev, nDatas);

                //第一个值为电平值，用来计算水分率
                double v = coef[0] +
                    coef[1] * nDatas[0] +
                    coef[2] * nDatas[0] * nDatas[0] +
                    coef[3] * nDatas[0] * nDatas[0] * nDatas[0] +
                    coef[4] * nDatas[0] * nDatas[0] * nDatas[0] * nDatas[0];

                v = CalcValue(nDatas[0], coef[0], coef[1], coef[2], coef[3], coef[4]);

                printf(" After Detection,");
                printf(" %d %d %d %d", nDatas[0], nDatas[1], nDatas[2], nDatas[3]);
                printf(" Water Rate:%lf", v);
                printf(" \n");
                printf("检测执行OK!\n");

            }
        }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}

//手动复位
void ManReset()
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);

    if (hWrDev)
    {
        int ret = ConnectDevice(hWrDev);

        if (ret >= 0)
        {
            ret = SendCommands(hWrDev, WR_RESET, 0, 15, 0); //下发复位

            if (ret <= 0)
            {
                printf("复位失败！\n");
            }
            else
            {
                printf("复位成功！\n");
            }
        }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}

void GetWeight()
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);

    if (hWrDev)
    {

        int ret = ConnectDevice(hWrDev);


        unsigned short nWeight = 0;

        if (ret >= 0)
        {
            //从水分仪器读取数据
            ret = ReadWeight(hWrDev, &nWeight);

            if (ret >= 0)
            {
                printf(" Weight Val: %d", nWeight);
                printf(" \n");
                printf("称重执行OK!\n");
            }
            else
            {
                printf("称重执行失败!\n");
            }
        }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}

void CurrVersion()
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);
    if (hWrDev)
    {
        int ret = ConnectDevice(hWrDev);

        //unsigned char nVersions[2] = { 0 };
        unsigned short nVersions;

        if (ret >= 0)
        {
            //从水分仪器读取数据
            ret = ReadVersion(hWrDev, &nVersions);

            if (ret >= 0)
            {
                printf(" Version1 Val: %d", nVersions & 0x00FF);
                printf(" \n");
                printf(" Version2 Val: %d", nVersions >> 8);
                printf(" \n");
            }
            else
            {
                printf("版本执行失败!\n");
            }
        }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}

void ExecPlcReady(void* hPlc, int nGrainType)
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);
    if (hWrDev)
    {
        int ret = ConnectDevice(hWrDev);

        if (ret >= 0)
        {
            //向水分仪发粮种更改，启动准备
            ret = SendCommands(hWrDev, WR_READY, nGrainType, 0, 500000);
            if (ret < 0)
            {
                printf("粮食品种修改失败！水分仪故障！\n");
                ret = ResponseState(hPlc, DEVICE_WR_FAULT);
            }
            else
            {
                printf("粮食品种修改成功！准备就绪\n");
                ret = ResponseState(hPlc, READY_FINISH);
            }
        }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}
void ExecPlcDetect(void* hPlc, int nTimeout /*以秒计*/)
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);
    if (hWrDev && hPlc)
    {
        int ret = ConnectDevice(hWrDev);

        if (ret >= 0)
        {
            ret = SendCommands(hWrDev, WR_DETECT, 0, nTimeout, 0);
            if (ret <= 0)
            {
                printf("执行检测失败！\n");
                ret = ResponseState(hPlc, DEVICE_WR_FAULT);
            }
            else
            {
                unsigned short nDatas[10] = { 0 };
                unsigned short nSendData[3] = { 0 };

                //从水分仪器读取数据
                ret = ReadDatas(hWrDev, nDatas);

                printf("执行检测成功！\n");
                ret = ResponseState(hPlc, DETECT_FINISH);

                //计算水分率
                double v = coef[0] +
                    coef[1] * nDatas[0] +
                    coef[2] * nDatas[0] * nDatas[0] +
                    coef[3] * nDatas[0] * nDatas[0] * nDatas[0] +
                    coef[4] * nDatas[0] * nDatas[0] * nDatas[0] * nDatas[0];


                nSendData[0] = 0x01; // 粮食品种
                nSendData[1] = 100 * v; // 21.30% //含水率
                nSendData[2] = 100 * nDatas[1] / 0.52; // 51.50; //容重比

                printf("Get Vals: wr:%f, weight:%f, temperatur:%f, humidity:%f",
                    v,
                    nDatas[1],
                    nDatas[2] / 100.f,
                    nDatas[3] / 100.f);

                ret = UploadData(hPlc, nSendData);
            }

        }

        Disconnect(hWrDev);

        DestroyDevice(hWrDev);
    }

    devRunning = false;
}
void ExecPlcReset(void* hPlc, int nTimeout /*以秒计*/)
{
    if (devRunning) { printf("水分仪忙!"); return; }

    devRunning = true;

    void* hWrDev = CreateWrDevice(sPortName, 115200, 'N', 8, 1);
    if (hWrDev)
    {
        int ret = ConnectDevice(hWrDev);

        if (ret >= 0)
        {
            //向水分仪发粮种更改，启动准备
            ret = SendCommands(hWrDev, WR_RESET, 0, nTimeout, 0);
            if (ret <= 0)
            {
                printf("复位失败！\n");
                ret = ResponseState(hPlc, DEVICE_WR_FAULT);
            }
            else
            {
                printf("复位成功!\n");
            }
        }

        Disconnect(hWrDev);
        DestroyDevice(hWrDev);
    }

    devRunning = false;
}

static void ExecPLCCommand()
{

    unsigned short nPlcCommandState = 0;
    unsigned short nPlcCommandGrainType = 0;
    float fPlcCommandDrift = 0;

    bool ret = -1;
    void* hPlcDev = CreatePlcDevice("127.0.0.1", 1502);
    if (hPlcDev) ret = ConnectDevice(hPlcDev);

    while (plcScan)  //按 c 退出自动检测
    {
        ret = ReadState(hPlcDev, &nPlcCommandState, &nPlcCommandGrainType);
        if (ret <= 0)
        {
            printf("读取PLC状态字异常！\n");
        }
        else
        {
            //读PLC状态字
            if (nPlcCommandGrainType > 0 && nPlcCommandState > 0)
            {
                //下面是主流程的处理
                switch (nPlcCommandState)
                {
                case READY_GRAIN: //粮食品种修改了
                    ExecPlcReady(hPlcDev, nPlcCommandGrainType);
                    break;
                case DETECT_START: //开始测试      
                    ExecPlcDetect(hPlcDev, 60);
                    break;
                case DEVICE_WR_RESET: //复位命令
                    ExecPlcReset(hPlcDev, 10);
                    break;
                }
            }
        }
        /*一秒读取PLC一次信息*/
        Sleep(1000);
    }

}

int main()
{

    std::cout << "水分仪测试程序已开启!\n";

    char ch = 0;
    while ('x' != ( ch = getchar() )) //按 x 退出程序
    {
        switch (ch)
        {
            case 'a': //自动测试
                {
                    std::thread workThread = std::thread(ExecPLCCommand);
                    workThread.detach();
                }
                break;
            case 'r': //手动检测,需要准备
                ManReady();
                break;
            case 'd': //手动检测，不许准备
                ManTest();
                break;
            case 'z':  //复位清零
                ManReset();
                break;
            case 'w':
                GetWeight();
                break;
            case 'V':
                CurrVersion();
                break;
            default:
                break;
        }

    }
    
    return 1;
}