// ActuatorDemo.cpp : 此文件包含 "main" 函数。程序执行将在此处开始并结束。
|
//
|
|
#include <iostream>
|
#include "../Actuator//Actuator.h"
|
|
//系数
|
const double coef[5] = { 1,1,0.01,0,0 };
|
|
void ExeTest()
|
{
|
void* hPlcDev = CreatePlcDevice("127.0.0.1", 1502);
|
void* hWrDev = CreateWrDevice("COM3", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hPlcDev) ret = ConnectDevice(hPlcDev);
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
char ch = 0;
|
|
while ('c' != (ch = getchar())) //按 c 退出自动检测
|
{
|
//读PLC状态字
|
ret = ReadState(hPlcDev, &nState, &nGrainType);
|
if (ret <= 0)
|
{
|
printf("读取PLC状态字异常！\n");
|
}
|
else if (nGrainType > 0 && nState > 0)
|
{
|
switch (nState)
|
{
|
case READY_GRAIN: //粮食品种修改了
|
{
|
//向水分仪发粮种更改，启动准备
|
ret = SendCommands(hWrDev, WR_READY, nGrainType, 10, 0);
|
if (ret <= 0)
|
{
|
printf("粮食品种修改失败！水分仪故障！\n");
|
ret = ResponseState(hPlcDev, DEVICE_WR_FAULT);
|
}
|
else
|
{
|
printf("粮食品种修改成功！准备就绪\n");
|
ret = ResponseState(hPlcDev, READY_FINISH);
|
}
|
|
}
|
break;
|
case DETECT_START: //开始测试
|
{
|
ret = SendCommands(hWrDev, WR_DETECT, 0, 15, 0);
|
if (ret <= 0)
|
{
|
printf("执行检测失败！\n");
|
ret = ResponseState(hPlcDev, DEVICE_WR_FAULT);
|
}
|
else
|
{
|
unsigned short nDatas[10] = { 0 };
|
|
//从水分仪器读取数据
|
ret = ReadDatas(hWrDev, nDatas);
|
|
printf("执行检测成功！\n");
|
ret = ResponseState(hPlcDev, 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];
|
|
nDatas[0] = 0x01; // 粮食品种
|
nDatas[1] = v; // 21.30% //含水率
|
nDatas[2] = 5150; // 51.50; //容重比
|
ret = UploadData(hPlcDev, nDatas);
|
}
|
}
|
break;
|
case DEVICE_WR_RESET: //复位命令
|
{
|
|
|
}
|
break;
|
default:
|
break;
|
}
|
}
|
}
|
|
if (hPlcDev) DestroyDevice(&hPlcDev);
|
if (hWrDev) DestroyDevice(&hWrDev);
|
}
|
|
//手动写参数
|
void ExeWriteParam()
|
{
|
void* hWrDev = CreateWrDevice("COM3", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
ret = WriteParams(hWrDev, 10500, 12000, 50, 1, 1);
|
if (ret <= 0)
|
printf("下发参数失败！\n");
|
|
if (hWrDev) DestroyDevice(&hWrDev);
|
}
|
|
|
//手动检测
|
void ExeManTest()
|
{
|
void* hWrDev = CreateWrDevice("COM3", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
ret = SendCommands(hWrDev, WR_READY, 0x01, 10, 0); //下发确认
|
|
if (ret <= 0)
|
printf("准备失败！\n");
|
else
|
{
|
ret = SendCommands(hWrDev, WR_DETECT, 0, 15, 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];
|
|
printf(" After Detection,");
|
printf(" %d %d %d %d", nDatas[0], nDatas[0], nDatas[0], nDatas[0]);
|
printf(" Water Rate:%lf", v);
|
printf(" \n");
|
|
}
|
|
}
|
|
if (hWrDev) DestroyDevice(&hWrDev);
|
}
|
|
//
|
void ExeVerifyTest()
|
{
|
void* hWrDev = CreateWrDevice("COM3", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
ret = SendCommands(hWrDev, WR_READY, 0x01, 10,0); //下发确认
|
|
if (ret <= 0)
|
{
|
printf("确认失败！\n");
|
}
|
else
|
{
|
ret = SendCommands(hWrDev, WR_VERIFY, 0, 15, 0); //执行启动命令
|
|
if (ret <= 0)
|
{
|
printf("校准执行失败！\n");
|
}
|
else
|
{
|
unsigned short nVcc = 0;
|
|
//从水分仪器读取数据
|
ret = ReadVcc(hWrDev, &nVcc);
|
|
printf(" Detected Val: %d", nVcc);
|
printf(" \n");
|
|
}
|
}
|
|
|
|
if (hWrDev) DestroyDevice(&hWrDev);
|
}
|
|
void TestLinearize()
|
{
|
int nSampeCount = 12;
|
|
float x[]={0,1,2,3,4,5,6,7,8,9,10,11}; //realval
|
float y[]={2506,2200,1846,1440,1004,548,79,-387,-847,-1288,-1700,-2066}; //input
|
double coef[5] = { 0 };
|
|
int ret = Linearize(x, y, coef, 2, nSampeCount);
|
if (ret > 0)
|
{
|
printf("Coef: %f, %f, %f, %f, %f\n", coef[0], coef[1], coef[2], coef[3], coef[4]);
|
|
float v = 3.0f;
|
printf("Input %lf, Cal Val:%lf\n", v,
|
(coef[0] +
|
coef[1] * v +
|
coef[2] * v * v +
|
coef[3] * v * v * v +
|
coef[4] * v * v * v * v)
|
);
|
}
|
|
}
|
|
int main()
|
{
|
std::cout << "Hello World!\n";
|
char ch = 0;
|
while ('x' != ( ch = getchar() )) //按 x 退出程序
|
{
|
switch (ch)
|
{
|
case 'a': //自动测试
|
ExeTest();
|
break;
|
case 'p': //向水份仪下发参数
|
ExeWriteParam();
|
break;
|
case 'd': //手动检测
|
ExeManTest();
|
break;
|
case 'v': //校准
|
ExeVerifyTest();
|
break;
|
case 'l': //拟合测试
|
TestLinearize();
|
break;
|
default:
|
break;
|
}
|
|
}
|
|
}
|
|
// 运行程序: Ctrl + F5 或调试 >“开始执行(不调试)”菜单
|
// 调试程序: F5 或调试 >“开始调试”菜单
|
|
// 入门使用技巧:
|
// 1. 使用解决方案资源管理器窗口添加/管理文件
|
// 2. 使用团队资源管理器窗口连接到源代码管理
|
// 3. 使用输出窗口查看生成输出和其他消息
|
// 4. 使用错误列表窗口查看错误
|
// 5. 转到“项目”>“添加新项”以创建新的代码文件，或转到“项目”>“添加现有项”以将现有代码文件添加到项目
|
// 6. 将来，若要再次打开此项目，请转到“文件”>“打开”>“项目”并选择 .sln 文件
|
