TCP Stack implemented
This commit is contained in:
parent
83103d679e
commit
4fceb602a5
7 changed files with 13909 additions and 0 deletions
458
Modbus TCP/IPClient.can
Normal file
458
Modbus TCP/IPClient.can
Normal file
|
@ -0,0 +1,458 @@
|
||||||
|
/*@@includes:*/
|
||||||
|
includes
|
||||||
|
{
|
||||||
|
#include "IPCommon.can"
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@var:*/
|
||||||
|
variables
|
||||||
|
{
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:SetupIp():*///function
|
||||||
|
void SetupIp()
|
||||||
|
{
|
||||||
|
int adapterIndex = 1;
|
||||||
|
char text[512] = "";
|
||||||
|
char info[512] = "";
|
||||||
|
int size = 512;
|
||||||
|
long result = 0;
|
||||||
|
dword addresses[1];
|
||||||
|
|
||||||
|
writeClear(0);
|
||||||
|
|
||||||
|
if (1 > IpGetAdapterCount())
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "Error: There is no network interface available!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != IpGetAdapterAddress(adapterIndex, addresses, 1))
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "Error: Could not retrieve ip address!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
gIpAddress = addresses[0]; // the interface used
|
||||||
|
|
||||||
|
if (INVALID_IP == gIpAddress)
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "Error: ip address to be used is invalid!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAdapterDescription(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Interface: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterAddressAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Ip address: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::TCPIP::TcpClientIp, text);
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpClientIp, text);
|
||||||
|
|
||||||
|
|
||||||
|
IpGetAdapterMaskAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Subnet mask: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterGatewayAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Gateway address: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
gStatus = gkSTATUS_INITIALISED;
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@startStart:Start:*/
|
||||||
|
on start
|
||||||
|
{
|
||||||
|
SetupIp();
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@stop:StopMeasurement:*/
|
||||||
|
on stopMeasurement
|
||||||
|
{
|
||||||
|
ResetIp();
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:OnTcpReceive(dword,long,dword,dword,char[],dword):*///function
|
||||||
|
void OnTcpReceive( dword socket, long result, dword address, dword port, char buffer[], dword size)
|
||||||
|
{
|
||||||
|
char addressString[64] = "";
|
||||||
|
|
||||||
|
if ( gTcpDataSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnTcpReceive called for unknown socket 0x%X", socket);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnTcpReceive error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAddressAsString(address, addressString, elcount(addressString));
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::TCPIP::TcpData, buffer);
|
||||||
|
|
||||||
|
TcpRecv( socket);
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:OnTcpSend(dword,long,char[],dword):*///function
|
||||||
|
void OnTcpSend( dword socket, long result, char buffer[], dword size)
|
||||||
|
{
|
||||||
|
if ( gTcpDataSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnTcpSend called for unknown socket 0x%X", socket);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnTcpSend error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:ConnectTcp():*///function
|
||||||
|
void ConnectTcp()
|
||||||
|
{
|
||||||
|
char buffer[64];
|
||||||
|
dword serverIp;
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::TCPIP::TcpServerIp, buffer, elcount(buffer));
|
||||||
|
|
||||||
|
serverIp = IpGetAddressAsNumber(buffer);
|
||||||
|
|
||||||
|
if (INVALID_IP == serverIp)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: invalid server Ip address!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
gTcpPort = @sysvar::TCPIP::TcpClientPort;
|
||||||
|
|
||||||
|
gTcpDataSocket = TcpOpen(gIpAddress, gTcpPort);
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gTcpDataSocket)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: could not open Tcp socket!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Tcp socket opened.");
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 == TcpConnect(gTcpDataSocket, serverIp, @sysvar::TCPIP::TcpServerPort))
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Successfully connected to server %s:%d", buffer, @sysvar::TCPIP::TcpServerPort);
|
||||||
|
|
||||||
|
TcpRecv( gTcpDataSocket);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:DisconnectTcp():*///function
|
||||||
|
void DisconnectTcp()
|
||||||
|
{
|
||||||
|
if (INVALID_SOCKET != gTcpDataSocket)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpDataSocket);
|
||||||
|
|
||||||
|
gTcpDataSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
writelineex(0, 1, "Tcp socket is closed.");
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:SendTcpData():*///function
|
||||||
|
void SendTcpData()
|
||||||
|
{
|
||||||
|
char buffer[8192];
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::TCPIP::TcpClientData, buffer, elcount(buffer));
|
||||||
|
|
||||||
|
if (INVALID_SOCKET == gTcpDataSocket)
|
||||||
|
{
|
||||||
|
writelineex( 0, 2, "Tcp socket is invalid!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != TcpSend( gTcpDataSocket, buffer, elcount(buffer)))
|
||||||
|
{
|
||||||
|
gIpLastErr = IpGetLastSocketError( gTcpDataSocket);
|
||||||
|
|
||||||
|
if ( WSA_IO_PENDING != gIpLastErr)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( gTcpDataSocket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "Tcp send error (%d): %s", gIpLastErr, gIpLastErrStr);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex( 0, 1, "Tcp data sent successfully!");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:SendUdpData():*///function
|
||||||
|
void SendUdpData()
|
||||||
|
{
|
||||||
|
char buffer[64]; // used for ip address
|
||||||
|
|
||||||
|
char data[4096]; // user data
|
||||||
|
|
||||||
|
dword serverIp;
|
||||||
|
|
||||||
|
int serverPort;
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gUdpSocket)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: Udp socket is not opened!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::UDP::UdpServerIp, buffer, elcount(buffer));
|
||||||
|
|
||||||
|
|
||||||
|
serverIp = IpGetAddressAsNumber(buffer);
|
||||||
|
|
||||||
|
if (INVALID_IP == serverIp)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: invalid server Ip address!");
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::UDP::UdpClientData, data, elcount(data));
|
||||||
|
|
||||||
|
if (0 == UdpSendTo(gUdpSocket, serverIp, @sysvar::UDP::UdpServerPort, data, elcount(data)))
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Successfully sent Udp data.");
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: an error occured while connecting to server %s:%d", serverIp, @sysvar::TCPIP::TcpServerPort);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:OpenUdpPort():*///function
|
||||||
|
void OpenUdpPort()
|
||||||
|
{
|
||||||
|
gUdpPort = @sysvar::UDP::UdpClientPort;
|
||||||
|
|
||||||
|
gUdpSocket = UdpOpen( gIpAddress, gUdpPort);
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gUdpSocket)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: could not create Udp socket!");
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Udp socket is opened successfully.");
|
||||||
|
|
||||||
|
UdpRecv( gUdpSocket);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:CloseUdpPort():*///function
|
||||||
|
void CloseUdpPort()
|
||||||
|
{
|
||||||
|
if (INVALID_SOCKET != gUdpSocket)
|
||||||
|
{
|
||||||
|
UdpClose(gUdpSocket);
|
||||||
|
|
||||||
|
gUdpSocket = INVALID_SOCKET;
|
||||||
|
|
||||||
|
writelineex(0, 2, "Udp port is closed.");
|
||||||
|
}
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpServerIp, "");
|
||||||
|
|
||||||
|
@sysvar::UDP::UdpServerPort = 0;
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:ResetIp():*///function
|
||||||
|
void ResetIp()
|
||||||
|
{
|
||||||
|
if (INVALID_SOCKET != gTcpDataSocket)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpDataSocket);
|
||||||
|
|
||||||
|
gTcpDataSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (INVALID_SOCKET != gUdpSocket)
|
||||||
|
{
|
||||||
|
UdpClose(gUdpSocket);
|
||||||
|
|
||||||
|
gUdpSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:OnUdpReceiveFrom(dword,long,dword,dword,char[],dword):*///function
|
||||||
|
void OnUdpReceiveFrom( dword socket, long result, dword address, dword port, char buffer[], dword count)
|
||||||
|
{
|
||||||
|
char addressString[64] = "";
|
||||||
|
|
||||||
|
if ( gUdpSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnUdpReceiveFrom called for unknown socket!");
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnUdpReceiveFrom error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAddressAsString(address, addressString, elcount(addressString));
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpServerIp, addressString);
|
||||||
|
|
||||||
|
@sysvar::UDP::UdpServerPort = port;
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpData, buffer);
|
||||||
|
|
||||||
|
|
||||||
|
UdpRecv( socket);
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:OnUdpSendTo(dword,long,char[],dword):*///function
|
||||||
|
void OnUdpSendTo( dword socket, long result, char buffer[], dword size)
|
||||||
|
{
|
||||||
|
if ( gUdpSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnUdpSendTo called for unknown socket 0x%X", socket);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnUdpSendTo error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Successfully sent Udp data.");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@caplFunc:OnTcpConnect(dword,long):*///function
|
||||||
|
void OnTcpConnect( dword socket, long result)
|
||||||
|
{
|
||||||
|
if ( gTcpDataSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnTcpConnect called for unknown socket 0x%X", socket);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnTcpConnect error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Successfully connected to server via Tcp");
|
||||||
|
|
||||||
|
TcpRecv( socket);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@sysvarUpdate:TCPIP::TcpConnect:*/
|
||||||
|
on sysvar_update sysvar::TCPIP::TcpConnect
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
ConnectTcp();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@sysvarUpdate:TCPIP::TcpDisconnect:*/
|
||||||
|
on sysvar_update sysvar::TCPIP::TcpDisconnect
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
DisconnectTcp();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@sysvarUpdate:TCPIP::TcpSend:*/
|
||||||
|
on sysvar_update sysvar::TCPIP::TcpSend
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
SendTcpData();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@sysvarUpdate:UDP::UdpClose:*/
|
||||||
|
on sysvar_update sysvar::UDP::UdpClose
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
CloseUdpPort();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@sysvarUpdate:UDP::UdpOpen:*/
|
||||||
|
on sysvar_update sysvar::UDP::UdpOpen
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
OpenUdpPort();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
||||||
|
/*@@sysvarUpdate:UDP::UdpSend:*/
|
||||||
|
on sysvar_update sysvar::UDP::UdpSend
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
SendUdpData();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
/*@@end*/
|
||||||
|
|
397
Modbus TCP/IPServer.can
Normal file
397
Modbus TCP/IPServer.can
Normal file
|
@ -0,0 +1,397 @@
|
||||||
|
includes
|
||||||
|
{
|
||||||
|
#include "IPCommon.can"
|
||||||
|
}
|
||||||
|
|
||||||
|
variables
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
void SetupIp()
|
||||||
|
{
|
||||||
|
int adapterIndex = 4;
|
||||||
|
char text[512] = "";
|
||||||
|
char info[512] = "";
|
||||||
|
int size = 512;
|
||||||
|
long result = 0;
|
||||||
|
dword addresses[1];
|
||||||
|
|
||||||
|
writeClear(0);
|
||||||
|
|
||||||
|
if (1 > IpGetAdapterCount())
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "Error: There is no network interface available!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != IpGetAdapterAddress(adapterIndex, addresses, 1))
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "Error: Could not retrieve Ip address!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
gIpAddress = addresses[0]; // the interface used
|
||||||
|
|
||||||
|
if (INVALID_IP == gIpAddress)
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "Error: Ip address to be used is invalid!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAdapterDescription(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Interface: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterAddressAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Ip address: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::TCPIP::TcpServerIp, text);
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpServerIp, text);
|
||||||
|
|
||||||
|
IpGetAdapterMaskAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Subnet mask: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterGatewayAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "Gateway address: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
gStatus = gkSTATUS_INITIALISED;
|
||||||
|
}
|
||||||
|
|
||||||
|
on start
|
||||||
|
{
|
||||||
|
SetupIp();
|
||||||
|
}
|
||||||
|
|
||||||
|
on stopMeasurement
|
||||||
|
{
|
||||||
|
ResetIp();
|
||||||
|
}
|
||||||
|
|
||||||
|
void OnTcpListen( dword socket, long result)
|
||||||
|
{
|
||||||
|
if (gTcpSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex( 0, 2, "OnTcpListen called for unexpected socket (%d).", socket);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if ( 0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnTcpListen error (%d, %s).",
|
||||||
|
IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (gTcpDataSocket != INVALID_SOCKET)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpDataSocket);
|
||||||
|
}
|
||||||
|
|
||||||
|
gTcpDataSocket = TcpAccept( socket);
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gTcpDataSocket)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "Error: TcpAccept (%d): %s",
|
||||||
|
IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
TcpRecv( gTcpDataSocket);
|
||||||
|
|
||||||
|
writelineex( 0, 1, "Status: Tcp connection established.");
|
||||||
|
}
|
||||||
|
|
||||||
|
long OnTcpReceive( dword socket, long result, dword address, dword port, char buffer[], dword size)
|
||||||
|
{
|
||||||
|
char addressString[64] = "";
|
||||||
|
|
||||||
|
if ( gTcpDataSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnTcpReceive called for unknown socket 0x%X", socket);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnTcpReceive error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAddressAsString(address, addressString, elcount(addressString));
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::TCPIP::TcpClientIp, addressString);
|
||||||
|
|
||||||
|
@sysvar::TCPIP::TcpClientPort = port;
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::TCPIP::TcpClientData, buffer);
|
||||||
|
|
||||||
|
TcpRecv( socket);
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void OnTcpSend( dword socket, long result, char buffer[], dword size)
|
||||||
|
{
|
||||||
|
if ( gTcpDataSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnTcpSend called for unknown socket 0x%X", socket);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnTcpSend error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex( 0, 1, "Tcp data sent successfully!");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void StartListenTcp()
|
||||||
|
{
|
||||||
|
gTcpPort = @sysvar::TCPIP::TcpServerPort;
|
||||||
|
|
||||||
|
gTcpSocket = TcpOpen(gIpAddress, gTcpPort);
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gTcpSocket)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: could not create Tcp socket!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
writelineex(0, 1, "Successfully created Tcp socket.");
|
||||||
|
|
||||||
|
TcpListen(gTcpSocket);
|
||||||
|
|
||||||
|
writelineex( 0, 1, "Listening for incoming Tcp connections on port %d", gTcpPort);
|
||||||
|
}
|
||||||
|
|
||||||
|
void StopListenTcp()
|
||||||
|
{
|
||||||
|
if (INVALID_SOCKET != gTcpDataSocket)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpDataSocket);
|
||||||
|
|
||||||
|
gTcpDataSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (INVALID_SOCKET != gTcpSocket)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpSocket);
|
||||||
|
|
||||||
|
gTcpSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
writelineex(0, 1, "Tcp socket is closed.");
|
||||||
|
}
|
||||||
|
|
||||||
|
void SendTcpData()
|
||||||
|
{
|
||||||
|
char buffer[4096];
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::TCPIP::TcpData, buffer, elcount(buffer));
|
||||||
|
|
||||||
|
if (INVALID_SOCKET != gTcpDataSocket)
|
||||||
|
|
||||||
|
if (0 != TcpSend( gTcpDataSocket, buffer, elcount(buffer)))
|
||||||
|
{
|
||||||
|
gIpLastErr = IpGetLastSocketError( gTcpDataSocket);
|
||||||
|
|
||||||
|
if ( WSA_IO_PENDING != gIpLastErr)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( gTcpDataSocket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "TcpSend error (%d): %s", gIpLastErr, gIpLastErrStr);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex( 0, 1, "Tcp data sent successfully!");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void SendUdpData()
|
||||||
|
{
|
||||||
|
char buffer[64]; // used for ip address
|
||||||
|
|
||||||
|
char data[4096]; // user data
|
||||||
|
|
||||||
|
dword clientIp;
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gUdpSocket)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: Udp socket is not opened!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::UDP::UdpClientIp, buffer, elcount(buffer));
|
||||||
|
|
||||||
|
clientIp = IpGetAddressAsNumber(buffer);
|
||||||
|
|
||||||
|
if (INVALID_IP == clientIp)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: invalid client Ip address!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
SysGetVariableString(sysvar::UDP::UdpData, data, elcount(data));
|
||||||
|
|
||||||
|
UdpSendTo(gUdpSocket, clientIp, @sysvar::UDP::UdpClientPort, data, elcount(data));
|
||||||
|
}
|
||||||
|
|
||||||
|
void OpenUdpPort()
|
||||||
|
{
|
||||||
|
gUdpPort = @sysvar::UDP::UdpServerPort;
|
||||||
|
|
||||||
|
gUdpSocket = UdpOpen( gIpAddress, gUdpPort);
|
||||||
|
|
||||||
|
if ( INVALID_SOCKET == gUdpSocket)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Error: could not create Udp socket!");
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Udp socket is opened successfully.");
|
||||||
|
|
||||||
|
UdpRecv( gUdpSocket);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void CloseUdpPort()
|
||||||
|
{
|
||||||
|
if (INVALID_SOCKET != gUdpSocket)
|
||||||
|
{
|
||||||
|
UdpClose(gUdpSocket);
|
||||||
|
|
||||||
|
gUdpSocket = INVALID_SOCKET;
|
||||||
|
|
||||||
|
writelineex(0, 1, "Udp port is closed.");
|
||||||
|
}
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpClientIp, "");
|
||||||
|
|
||||||
|
@sysvar::UDP::UdpClientPort = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
void ResetIp()
|
||||||
|
{
|
||||||
|
if (INVALID_SOCKET != gTcpDataSocket)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpDataSocket);
|
||||||
|
|
||||||
|
gTcpDataSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (INVALID_SOCKET != gTcpSocket)
|
||||||
|
{
|
||||||
|
TcpClose(gTcpSocket);
|
||||||
|
|
||||||
|
gTcpSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (INVALID_SOCKET != gUdpSocket)
|
||||||
|
{
|
||||||
|
UdpClose(gUdpSocket);
|
||||||
|
|
||||||
|
gUdpSocket = INVALID_SOCKET;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void OnUdpReceiveFrom( dword socket, long result, dword address, dword port, char buffer[], dword count)
|
||||||
|
{
|
||||||
|
char addressString[64] = "";
|
||||||
|
|
||||||
|
if ( gUdpSocket != socket)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "OnUdpReceiveFrom called for unknown socket!");
|
||||||
|
}
|
||||||
|
|
||||||
|
if (0 != result)
|
||||||
|
{
|
||||||
|
IpGetLastSocketErrorAsString( socket, gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "OnUdpReceiveFrom error (%d): %s", IpGetLastSocketError( socket), gIpLastErrStr);
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAddressAsString(address, addressString, elcount(addressString));
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpClientIp, addressString);
|
||||||
|
|
||||||
|
@sysvar::UDP::UdpClientPort = port;
|
||||||
|
|
||||||
|
SysSetVariableString(sysvar::UDP::UdpClientData, buffer);
|
||||||
|
|
||||||
|
UdpRecv( socket);
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar_update sysvar::TCPIP::TcpSend
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
SendTcpData();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar_update sysvar::TCPIP::TcpStartListen
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
StartListenTcp();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar_update sysvar::TCPIP::TcpStopListen
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
StopListenTcp();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar_update sysvar::UDP::UdpClose
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
CloseUdpPort();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar_update sysvar::UDP::UdpOpen
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
OpenUdpPort();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar_update sysvar::UDP::UdpSend
|
||||||
|
{
|
||||||
|
if (@this)
|
||||||
|
{
|
||||||
|
SendUdpData();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
241
Modbus TCP/TcpCommon.can
Normal file
241
Modbus TCP/TcpCommon.can
Normal file
|
@ -0,0 +1,241 @@
|
||||||
|
/*@!Encoding:1252*/
|
||||||
|
includes
|
||||||
|
{
|
||||||
|
}
|
||||||
|
|
||||||
|
variables
|
||||||
|
{
|
||||||
|
const long WSA_IO_PENDING = 997;
|
||||||
|
const long WSAEWOULDBLOCK = 10035;
|
||||||
|
const dword INVALID_IP = 0xffffffff;
|
||||||
|
|
||||||
|
long gIpLastErr = 0;
|
||||||
|
char gIpLastErrStr[512] = "";
|
||||||
|
TcpSocket gSocket;
|
||||||
|
|
||||||
|
|
||||||
|
char gTcpRxBuffer[8192];
|
||||||
|
char gUdpRxBuffer[4096];
|
||||||
|
/*
|
||||||
|
|
||||||
|
dword gIpAddress = INVALID_IP;
|
||||||
|
char gIpLastErrStr[1024] = "";
|
||||||
|
char gIpAddressStr[32] = "";
|
||||||
|
int gIpLastErr = 0;
|
||||||
|
|
||||||
|
dword gUdpPort = 0;
|
||||||
|
long gUdpSocket = INVALID_SOCKET;
|
||||||
|
|
||||||
|
dword gTcpPort = 0;
|
||||||
|
long gTcpSocket = INVALID_SOCKET;
|
||||||
|
long gTcpDataSocket = INVALID_SOCKET;
|
||||||
|
|
||||||
|
// status
|
||||||
|
int gStatus = 0;
|
||||||
|
const int gkSTATUS_UNINITIALISED = 0;
|
||||||
|
const int gkSTATUS_INITIALISED = 1;
|
||||||
|
*/
|
||||||
|
}
|
||||||
|
/*
|
||||||
|
long UdpRecv()
|
||||||
|
{
|
||||||
|
int result = 0;
|
||||||
|
|
||||||
|
result = gSocket.UdpReceiveFrom(gUdpRxBuffer, elcount( gUdpRxBuffer));
|
||||||
|
|
||||||
|
if ( 0 != result)
|
||||||
|
{
|
||||||
|
gIpLastErr = gSocket.GetLastSocketError();
|
||||||
|
|
||||||
|
if ( WSA_IO_PENDING != gIpLastErr)
|
||||||
|
{
|
||||||
|
gSocket.GetLastSocketErrorAsString(gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex( 0, 2, "UdpReceive error (%d): %s", gIpLastErr, gIpLastErrStr);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
|
||||||
|
dword SetupIp(char Local_IP[])
|
||||||
|
{
|
||||||
|
int adapterIndex;
|
||||||
|
char text[512] = "";
|
||||||
|
char info[512] = "";
|
||||||
|
int size = 512;
|
||||||
|
dword addresses[1];
|
||||||
|
dword address;
|
||||||
|
|
||||||
|
writeClear(0);
|
||||||
|
|
||||||
|
if (IpGetAdapterCount() < 1)
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "<%BASE_FILE_NAME%> Error: There is no network interface available!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
adapterIndex = @sysvar::TCPIP::AdapterIndex;
|
||||||
|
|
||||||
|
if (IpGetAdapterAddress(adapterIndex, addresses, 1) != 0)
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "<%BASE_FILE_NAME%> Error: Could not retrieve ip address!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
address = addresses[0]; // the interface used
|
||||||
|
|
||||||
|
if (address == INVALID_IP)
|
||||||
|
{
|
||||||
|
writelineex(0, 3, "<%BASE_FILE_NAME%> Error: ip address to be used is invalid!");
|
||||||
|
|
||||||
|
stop();
|
||||||
|
}
|
||||||
|
|
||||||
|
IpGetAdapterDescription(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "<%BASE_FILE_NAME%> Interface: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterAddressAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "<%BASE_FILE_NAME%> Ip address: %s", text);
|
||||||
|
strncpy(Local_IP, text, 16);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterMaskAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "<%BASE_FILE_NAME%> Subnet mask: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
IpGetAdapterGatewayAsString(adapterIndex, text, size);
|
||||||
|
snprintf(info, size, "<%BASE_FILE_NAME%> Gateway address: %s", text);
|
||||||
|
writelineex(0, 1, info);
|
||||||
|
|
||||||
|
return address;
|
||||||
|
}
|
||||||
|
|
||||||
|
word OpenSocket()
|
||||||
|
{
|
||||||
|
char Local_IP[16];
|
||||||
|
dword localIp;
|
||||||
|
word localPort;
|
||||||
|
dword i = 0;
|
||||||
|
CHAR errorText[200];
|
||||||
|
|
||||||
|
localIp = SetupIp(Local_IP);
|
||||||
|
localPort = random(65535-10240)+10240;
|
||||||
|
|
||||||
|
// Try to open socket
|
||||||
|
do
|
||||||
|
{
|
||||||
|
gSocket = TcpSocket::Open(localIp, localPort);
|
||||||
|
if (gSocket.GetLastSocketError() != 0)
|
||||||
|
{
|
||||||
|
gSocket.GetLastSocketErrorAsString(errorText, elcount(errorText));
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> Error: could not open Tcp socket on %s:%d, %s (%d)!", Local_IP, localPort, errorText, gSocket.GetLastSocketError());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
while (gSocket.GetLastSocketError() != 0 && i++ < 9);
|
||||||
|
|
||||||
|
if (gSocket.GetLastSocketError() != 0)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> Error: could not open Tcp socket!");
|
||||||
|
return gSocket.GetLastSocketError();
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> Tcp socket opened on %s:%d.", Local_IP, localPort);
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
word TcpConnectTo(char Remote_IP[], word remotePort)
|
||||||
|
{
|
||||||
|
dword remoteIp;
|
||||||
|
long fehler;
|
||||||
|
|
||||||
|
// Try to open a socket
|
||||||
|
fehler = OpenSocket();
|
||||||
|
if (fehler != 0)
|
||||||
|
{
|
||||||
|
return fehler;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Convert IP string to Number
|
||||||
|
remoteIp = IpGetAddressAsNumber(Remote_IP);
|
||||||
|
if (remoteIp == INVALID_IP)
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> Error: invalid server Ip address!");
|
||||||
|
|
||||||
|
return 1;
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
// Connect to Server
|
||||||
|
if (gSocket.Connect(remoteIp, remotePort) != 0)
|
||||||
|
{
|
||||||
|
fehler = gSocket.GetLastSocketError();
|
||||||
|
|
||||||
|
if (fehler != WSAEWOULDBLOCK) // OnTcpConnect will be called otherwise
|
||||||
|
{
|
||||||
|
write("<%BASE_FILE_NAME%> No Port-Connection: %d", fehler);
|
||||||
|
return fehler;
|
||||||
|
}
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> Successfully connected to server %s:%d", Remote_IP, remotePort);
|
||||||
|
TcpRecv();
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void OnTcpConnect(dword socket, long result)
|
||||||
|
{
|
||||||
|
if (result != 0)
|
||||||
|
{
|
||||||
|
gSocket.GetLastSocketErrorAsString(gIpLastErrStr, elcount(gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex(0, 2, "<%BASE_FILE_NAME%> OnTcpConnect error (%d): %s", gSocket.GetLastSocketError(), gIpLastErrStr);
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> Successfully connected to server");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
long TcpRecv()
|
||||||
|
{
|
||||||
|
int result;
|
||||||
|
|
||||||
|
result = gSocket.Receive(gTcpRxBuffer, elcount(gTcpRxBuffer));
|
||||||
|
|
||||||
|
if (result != 0)
|
||||||
|
{
|
||||||
|
gIpLastErr = gSocket.GetLastSocketError();
|
||||||
|
|
||||||
|
if (WSA_IO_PENDING != gIpLastErr)
|
||||||
|
{
|
||||||
|
gSocket.GetLastSocketErrorAsString(gIpLastErrStr, elcount( gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex(0, 2, "<%BASE_FILE_NAME%> TcpReceive error (%d): %s", gIpLastErr, gIpLastErrStr);
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> TcpReceive was IO pending", gTcpRxBuffer);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "<%BASE_FILE_NAME%> TcpReceive: %s", gTcpRxBuffer);
|
||||||
|
}
|
||||||
|
|
||||||
|
return result;
|
||||||
|
}
|
6710
Modbus TCP/modbus.cfg
Normal file
6710
Modbus TCP/modbus.cfg
Normal file
File diff suppressed because it is too large
Load diff
18
Modbus TCP/sender.can
Normal file
18
Modbus TCP/sender.can
Normal file
|
@ -0,0 +1,18 @@
|
||||||
|
includes
|
||||||
|
{
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
variables
|
||||||
|
{
|
||||||
|
int gedrueckt=0;
|
||||||
|
}
|
||||||
|
|
||||||
|
on sysvar senden
|
||||||
|
{
|
||||||
|
if (gedrueckt==1) {return;};
|
||||||
|
if (@senden==0) {gedrueckt=0;}; // Rücksetzen wenn Button losgelassen
|
||||||
|
|
||||||
|
write ("Gedrueckt");
|
||||||
|
|
||||||
|
}
|
79
Modbus TCP/socket.can
Normal file
79
Modbus TCP/socket.can
Normal file
|
@ -0,0 +1,79 @@
|
||||||
|
/*@!Encoding:1252*/
|
||||||
|
|
||||||
|
includes
|
||||||
|
{
|
||||||
|
#include "TcpCommon.can"
|
||||||
|
}
|
||||||
|
|
||||||
|
variables
|
||||||
|
{
|
||||||
|
int state = 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Get information of local network interface such like ip address
|
||||||
|
|
||||||
|
on preStart
|
||||||
|
{
|
||||||
|
setStartdelay(1000);
|
||||||
|
}
|
||||||
|
|
||||||
|
on start
|
||||||
|
{
|
||||||
|
long fehler;
|
||||||
|
|
||||||
|
fehler = TcpConnectTo("192.168.1.3", 502);
|
||||||
|
state = fehler == 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
on key 'd'
|
||||||
|
{
|
||||||
|
SendTcpData();
|
||||||
|
}
|
||||||
|
|
||||||
|
void SendTcpData()
|
||||||
|
{
|
||||||
|
const word length = 12;
|
||||||
|
char buffer[length];
|
||||||
|
|
||||||
|
if (state == 0)
|
||||||
|
{
|
||||||
|
writelineex(0, 2, "Tcp socket is invalid!");
|
||||||
|
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
|
||||||
|
// Modbus Application Header
|
||||||
|
buffer[00] = 0x23; // [2] Transaction ID
|
||||||
|
buffer[01] = 0x45;
|
||||||
|
buffer[02] = 0x00; // [2] Protocol ID = 0
|
||||||
|
buffer[03] = 0x00;
|
||||||
|
buffer[04] = (length-6)>>8; // [2] Length; Number of bytes following
|
||||||
|
buffer[05] = (length-6);
|
||||||
|
buffer[06] = 0xFF; // [1] Unit identifier; not relevant
|
||||||
|
// Payload
|
||||||
|
buffer[07] = 0x01; // [1] Function Code; 1:Read DI; 2:Read DIO; 3:Read AIO; 4:Read AI; 5:Write 1 DO; 6:Write 1 AO; 7: Read Exeption, 15:Write n DO; 16:Write n AO;
|
||||||
|
buffer[08] = 0x00; // [2] Start address
|
||||||
|
buffer[09] = 0x00;
|
||||||
|
buffer[10] = 0x01; // [2] Number of items; 1:max 2000=0x7D0
|
||||||
|
buffer[11] = 0xFF;
|
||||||
|
|
||||||
|
write("Sende '%s' (Länge: %d)", buffer, length);
|
||||||
|
|
||||||
|
if (gSocket.Send(buffer, elCount(buffer)) != 0)
|
||||||
|
{
|
||||||
|
gIpLastErr = gSocket.GetLastSocketError();
|
||||||
|
|
||||||
|
if (gIpLastErr != WSA_IO_PENDING)
|
||||||
|
{
|
||||||
|
gSocket.GetLastSocketErrorAsString(gIpLastErrStr, elcount(gIpLastErrStr));
|
||||||
|
|
||||||
|
writelineex(0, 2, "Tcp send error (%d): %s", gIpLastErr, gIpLastErrStr);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
writelineex(0, 1, "Tcp data sent successfully!");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/**/
|
6006
Modbus TCP/socket.cfg
Normal file
6006
Modbus TCP/socket.cfg
Normal file
File diff suppressed because it is too large
Load diff
Loading…
Reference in a new issue