// ActuatorDemo.cpp : 此文件包含 "main" 函数。程序执行将在此处开始并结束。
|
//
|
|
#include <iostream>
|
#include "../Actuator//Actuator.h"
|
|
//系数
|
const double coef[5] = { -6.204673384923,0.025161776479,-0.000014765722,0.000000003440,0 };
|
|
void ExeTest()
|
{
|
void* hPlcDev = CreatePlcDevice("192.168.0.10", 502);
|
void* hWrDev = CreateWrDevice("COM1", 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, 20, 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, 30, 0);
|
if (ret <= 0)
|
{
|
printf("执行检测失败！\n");
|
ret = ResponseState(hPlcDev, DEVICE_WR_FAULT);
|
}
|
else
|
{
|
unsigned short nDatas[10] = { 0 };
|
unsigned short nSendData[3] = { 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];
|
|
|
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(hPlcDev, nSendData);
|
}
|
}
|
break;
|
case DEVICE_WR_RESET: //复位命令
|
{
|
|
ret = SendCommands(hWrDev, WR_RESET, 0, 20, 0);
|
if (ret <= 0)
|
{
|
printf("复位失败！\n");
|
ret = ResponseState(hPlcDev, DEVICE_WR_FAULT);
|
}
|
else
|
{
|
printf("复位成功!\n");
|
}
|
}
|
break;
|
default:
|
break;
|
}
|
}
|
}
|
}
|
|
if (hPlcDev) Disconnect(hPlcDev);
|
if (hPlcDev) DestroyDevice(hPlcDev);
|
if (hWrDev) Disconnect(hWrDev);
|
if (hWrDev) DestroyDevice(hWrDev);
|
}
|
|
|
//手动写参数
|
void ExeWriteParam()
|
{
|
void* hWrDev = CreateWrDevice("COM6", 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 ExeManReady()
|
{
|
void* hWrDev = CreateWrDevice("COM6", 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, 20, 0); //下发确认
|
|
if (ret <= 0)
|
printf("准备失败！\n");
|
else
|
{
|
printf("准备就绪，OK！\n");
|
}
|
|
if (hWrDev) DestroyDevice(hWrDev);
|
}
|
|
//手动检测
|
void ExeManTest()
|
{
|
void* hWrDev = CreateWrDevice("COM6", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
ret = SendCommands(hWrDev, WR_DETECT, 0, 30, 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");
|
|
}
|
|
|
if (hWrDev) DestroyDevice(hWrDev);
|
}
|
|
void DirectDetect(char nType)
|
{
|
|
void* hWrDev = CreateWrDevice("COM6", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = nType-48;
|
int ret = 0;
|
|
if (nGrainType < 1 && nGrainType>4)
|
{
|
printf("粮食信息非法!\r\n");
|
return;
|
}
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
|
ret = SendCommands(hWrDev, WR_GOODS, nGrainType); //执行启动命令
|
if (ret <= 0)
|
{
|
printf("下发粮种信息失败！\n");
|
}
|
else
|
{
|
ret = SendCommands(hWrDev, WR_DETECT, 0, 30, 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(" Orig Val: %d %d %d %d", nDatas[0], nDatas[1], nDatas[2], nDatas[3]);
|
printf(" -->Water Rate:%lf", v);
|
printf(" \n");
|
printf("检测执行OK!\n");
|
|
}
|
|
}
|
|
|
|
if (hWrDev) DestroyDevice(hWrDev);
|
|
}
|
//
|
void ExeVerifyTest()
|
{
|
void* hWrDev = CreateWrDevice("COM6", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
ret = SendCommands(hWrDev, WR_VERIFY, 0, 30, 0); //执行校准命令
|
|
if (ret <= 0)
|
{
|
printf("校准执行失败！\n");
|
}
|
else
|
{
|
unsigned short nVcc = 0;
|
|
//从水分仪器读取数据
|
ret = ReadVcc(hWrDev, &nVcc);
|
|
printf(" Detected Val: %d", nVcc);
|
printf(" \n");
|
printf("校准执行OK!\n");
|
}
|
|
if (hWrDev) DestroyDevice(hWrDev);
|
}
|
|
void ExeZero()
|
{
|
void* hWrDev = CreateWrDevice("COM6", 115200, 'N', 8, 1);
|
|
unsigned short nState = 0;
|
unsigned short nGrainType = 0;
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
ret = SendCommands(hWrDev, WR_RESET, 0, 15, 0); //下发复位
|
|
if (ret <= 0)
|
{
|
printf("复位失败！\n");
|
}
|
else
|
{
|
printf("复位成功！\n");
|
}
|
|
|
|
|
if (hWrDev) DestroyDevice(hWrDev);
|
}
|
|
void ReadWeight()
|
{
|
void* hWrDev = CreateWrDevice("COM1", 115200, 'N', 8, 1);
|
|
int ret = 0;
|
|
if (hWrDev) ret = ConnectDevice(hWrDev);
|
|
|
unsigned short nWeight = 0;
|
|
//从水分仪器读取数据
|
ret = ReadWeight(hWrDev, &nWeight);
|
|
if (ret >= 0)
|
{
|
printf(" Weight Val: %d", nWeight);
|
printf(" \n");
|
printf("称重执行OK!\n");
|
}
|
else
|
{
|
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";
|
|
//double val = 11531998.626;
|
//unsigned char sval[32] = { 0 };
|
|
//memcpy(sval, &val, 8);
|
|
//unsigned char sv2[] = { 0x27, 0x31, 0x08, 0xd4, 0xdb, 0xfe, 0x65, 0x41 };
|
//val = *(double*)sv2;
|
//
|
//unsigned short sv3[] = { 0x3127, 0xd408, 0xfedb, 0x4165 };
|
//val = *(double*)sv3;
|
|
//unsigned short sv4[] = { 0x2731, 0x08d4, 0xdbfe, 0x6541 };
|
//val = *(double*)sv4;
|
|
//unsigned short sv5[] = { 0x4165, 0xfedb, 0xd408, 0x3127 };
|
//val = *(double*)sv5;
|
|
char ch = 0;
|
while ('x' != ( ch = getchar() )) //按 x 退出程序
|
{
|
switch (ch)
|
{
|
case 'a': //自动测试
|
ExeTest();
|
break;
|
case 'p': //向水份仪下发参数
|
ExeWriteParam();
|
break;
|
case 'r': //手动检测,需要准备
|
ExeManReady();
|
break;
|
case 'd': //手动检测，不许准备
|
ExeManTest();
|
break;
|
case 'v': //校准
|
ExeVerifyTest();
|
break;
|
case 'z': //复位清零
|
ExeZero();
|
break;
|
case 'l': //拟合测试
|
TestLinearize();
|
break;
|
case '1':
|
case '2':
|
case '3':
|
case '4':
|
DirectDetect(ch);
|
break;
|
case 'w':
|
ReadWeight();
|
break;
|
default:
|
break;
|
}
|
|
}
|
|
}
|
|
// 运行程序: Ctrl + F5 或调试 >“开始执行(不调试)”菜单
|
// 调试程序: F5 或调试 >“开始调试”菜单
|
|
// 入门使用技巧:
|
// 1. 使用解决方案资源管理器窗口添加/管理文件
|
// 2. 使用团队资源管理器窗口连接到源代码管理
|
// 3. 使用输出窗口查看生成输出和其他消息
|
// 4. 使用错误列表窗口查看错误
|
// 5. 转到“项目”>“添加新项”以创建新的代码文件，或转到“项目”>“添加现有项”以将现有代码文件添加到项目
|
// 6. 将来，若要再次打开此项目，请转到“文件”>“打开”>“项目”并选择 .sln 文件
|
