1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
|
/*
RailControl - Model Railway Control Software
Copyright (c) 2017-2025 by Teddy / Dominik Mahrer - www.railcontrol.org
RailControl is free software; you can redistribute it and/or modify it
under the terms of the GNU General Public License as published by the
Free Software Foundation; either version 3, or (at your option) any
later version.
RailControl is distributed in the hope that it will be useful, but
WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
See the GNU General Public License for more details.
You should have received a copy of the GNU General Public License
along with RailControl; see the file LICENCE. If not see
<http://www.gnu.org/licenses/>.
*/
#include "Hardware/CS2Udp.h"
#include "Utils/Utils.h"
namespace Hardware
{
CS2Udp::CS2Udp(const HardwareParams* params)
: MaerklinCAN(params,
"Maerklin Central Station 2 (CS2) UDP / " + params->GetName() + " at IP " + params->GetArg1(),
params->GetName()),
senderConnection(HardwareInterface::logger, params->GetArg1(), CS2SenderPort),
receiverConnection(HardwareInterface::logger, "0.0.0.0", CS2ReceiverPort)
{
HardwareInterface::logger->Info(Languages::TextStarting, GetFullName());
if (senderConnection.IsConnected())
{
HardwareInterface::logger->Info(Languages::TextSenderSocketCreated);
}
else
{
HardwareInterface::logger->Error(Languages::TextUnableToCreateUdpSocketForSendingData);
}
Init();
}
CS2Udp::~CS2Udp()
{
receiverConnection.Terminate();
HardwareInterface::logger->Info(Languages::TextTerminatingSenderSocket);
}
void CS2Udp::Send(const unsigned char* buffer)
{
if (senderConnection.Send(buffer, CANCommandBufferLength) == -1)
{
HardwareInterface::logger->Error(Languages::TextUnableToSendDataToControl);
}
}
void CS2Udp::Receiver()
{
if (!receiverConnection.IsConnected())
{
HardwareInterface::logger->Error(Languages::TextUnableToCreateUdpSocketForReceivingData);
return;
}
bool ret = receiverConnection.Bind();
if (!ret)
{
HardwareInterface::logger->Error(Languages::TextUnableToBindUdpSocket);
return;
}
unsigned char buffer[CANCommandBufferLength];
while(run)
{
ssize_t datalen = receiverConnection.Receive(buffer, sizeof(buffer));
if (!run)
{
break;
}
if (datalen < 0)
{
HardwareInterface::logger->Error(Languages::TextUnableToReceiveData);
break;
}
if (datalen == 0)
{
// no data received
continue;
}
if (datalen != 13)
{
HardwareInterface::logger->Error(Languages::TextInvalidDataReceived);
continue;
}
Parse(buffer);
}
receiverConnection.Terminate();
}
} // namespace
|
