wirenboard / wb-mqtt-serial / 2

Committed 29 Dec 2025 12:28PM UTC coverage: 76.817% (+4.0%) from 72.836%

Build # 2

Build Type

Pull #1045

github

Specific Base 54aa0c

Committed by

pgasheev

Commit Message

up changelog

Pull Request Pull Request #1045: Fix firmware version in WB-M1W2 template

Run Details

6873 of 9161 branches covered (75.02%)

12966 of 16879 relevant lines covered (76.82%)

1651.61 hits per line

Source File
Press 'n' to go to next uncovered line, 'b' for previous

89.71

/src/devices/ivtm_device.cpp

#include <cstdio>
#include <cstring>
#include <errno.h>
#include <fcntl.h>
#include <stdio.h>
#include <string.h>
#include <string>
#include <sys/ioctl.h>
#include <sys/select.h>
#include <sys/stat.h>
#include <sys/types.h>
#include <termios.h>
#include <unistd.h>

#include "ivtm_device.h"

void TIVTMDevice::Register(TSerialDeviceFactory& factory)
{
    factory.RegisterProtocol(
        new TUint32SlaveIdProtocol("ivtm", TRegisterTypes({{0, "default", "value", Float, true}})),
        new TBasicDeviceFactory<TIVTMDevice>("#/definitions/simple_device", "#/definitions/common_channel"));
}

TIVTMDevice::TIVTMDevice(PDeviceConfig config, PProtocol protocol)
    : TSerialDevice(config, protocol),
      TUInt32SlaveId(config->SlaveId)
{}

void TIVTMDevice::WriteCommand(TPort& port, uint16_t addr, uint16_t data_addr, uint8_t data_len)
{
    port.CheckPortOpen();
    uint8_t buf[16];
    buf[0] = '$';

    snprintf((char*)&buf[1], 3, "%02X", addr >> 8);
    snprintf((char*)&buf[3], 3, "%02X", addr & 0xFF);

    buf[5] = 'R';
    buf[6] = 'R';

    snprintf((char*)&buf[7], 3, "%02X", data_addr >> 8);
    snprintf((char*)&buf[9], 3, "%02X", data_addr & 0xFF);

    snprintf((char*)&buf[11], 3, "%02X", data_len);

    uint8_t crc8 = 0;
    for (size_t i = 0; i < 13; ++i) {
        crc8 += buf[i];
    }

    snprintf((char*)&buf[13], 3, "%02X", crc8);
    buf[15] = 0x0d;

    port.WriteBytes(buf, 16);
}

static const int MAX_LEN = 100;

bool TIVTMDevice::DecodeASCIIBytes(uint8_t* buf, uint8_t* result, uint8_t len_bytes)
{
    for (size_t i = 0; i < len_bytes; ++i) {
        result[i] = DecodeASCIIByte(buf + i * 2);
    }
    return true;
}

uint8_t TIVTMDevice::DecodeASCIIByte(uint8_t* buf)
{
    std::string s(buf, buf + 2);
    return stoul(s, nullptr, 16);
}

uint16_t TIVTMDevice::DecodeASCIIWord(uint8_t* buf)
{
    uint8_t decoded_buf[2];
    DecodeASCIIBytes(buf, decoded_buf, 2);

    return (decoded_buf[0] << 8) | decoded_buf[1];
}

void TIVTMDevice::ReadResponse(TPort& port, uint16_t addr, uint8_t* payload, uint16_t len)
{
    uint8_t buf[MAX_LEN];

    auto nread = port.ReadFrame(buf,
                                MAX_LEN,
                                GetResponseTimeout(port),
                                GetFrameTimeout(port),
                                [](uint8_t* buf, int size) { return size > 0 && buf[size - 1] == '\r'; })
                     .Count;
    if (nread < 10)
        throw TSerialDeviceTransientErrorException("frame too short");

    if ((buf[0] != '!') || (buf[5] != 'R') || (buf[6] != 'R')) {
        throw TSerialDeviceTransientErrorException("invalid response header");
    }

    if (buf[nread - 1] != 0x0D) {
        throw TSerialDeviceTransientErrorException("invalid response footer");
    }

    if (DecodeASCIIWord(&buf[1]) != addr) {
        throw TSerialDeviceTransientErrorException("invalid slave addr in response");
    }

    uint8_t crc8 = 0;
    for (size_t i = 0; i < (size_t)nread - 3; ++i) {
        crc8 += buf[i];
    }

    uint8_t actualCrc = DecodeASCIIByte(&buf[nread - 3]);

    if (crc8 != actualCrc)
        throw TSerialDeviceTransientErrorException("invalid crc");

    int actualPayloadSize = nread - 10; // in ASCII symbols
    if (len * 2 != actualPayloadSize) {
        throw TSerialDeviceTransientErrorException("unexpected frame size");
    } else {
        len = actualPayloadSize / 2;
    }

    DecodeASCIIBytes(buf + 7, payload, len);
}

TRegisterValue TIVTMDevice::ReadRegisterImpl(TPort& port, const TRegisterConfig& reg)
{
    port.SkipNoise();

    auto addr = GetUint32RegisterAddress(reg.GetAddress());
    WriteCommand(port, SlaveId, addr, reg.GetByteWidth());
    uint8_t response[4];
    ReadResponse(port, SlaveId, response, reg.GetByteWidth());

    uint8_t* p = response; //&response[(address % 2) * 4];

    // the response is little-endian. We inverse the byte order here to make it big-endian.

    return TRegisterValue{static_cast<uint64_t>((p[3] << 24) | (p[2] << 16) | (p[1] << 8) | p[0])};
}

#if 0
int main(int, char**)
{
    try {
        TIVTMDevice bus("/dev/ttyNSC1");
        bus.Open();
        int v = bus.ReadRegister(0x01, 0x0a);
        std::cout << "value of mod 0x01 reg 0x0a: " << v << std::endl;
        for (int i = 0; i < 8; ++i) {
            bus.WriteRegister(0x01, 0x02 + i, 0x00); // manual control of the channel (low threshold = 0)
            int address = 0x1a + i;
            std::cout << "value of relay " << i << ": " << (int)bus.ReadRegister(0x01, address) << std::endl;
            bus.WriteRegister(0x01, address, 0xff);
            std::cout << "value of relay " << i << " (on): " << (int)bus.ReadRegister(0x01, address) << std::endl;
            sleep(1);
            bus.WriteRegister(0x01, address, 0x00);
            std::cout << "value of relay " << i << " (off): " << (int)bus.ReadRegister(0x01, address) << std::endl;
        }
    } catch (const TIVTMDeviceException& e) {
        std::cerr << "uniel bus error: " << e.what() << std::endl;
    }
    return 0;
}
#endif

1	#include <cstdio>
2	#include <cstring>
3	#include <errno.h>
4	#include <fcntl.h>
5	#include <stdio.h>
6	#include <string.h>
7	#include <string>
8	#include <sys/ioctl.h>
9	#include <sys/select.h>
10	#include <sys/stat.h>
11	#include <sys/types.h>
12	#include <termios.h>
13	#include <unistd.h>
14
15	#include "ivtm_device.h"
16
17	void TIVTMDevice::Register(TSerialDeviceFactory& factory)	288✔
18	{
19	factory.RegisterProtocol(	288✔
20	new TUint32SlaveIdProtocol("ivtm", TRegisterTypes({{0, "default", "value", Float, true}})),	864✔
21	new TBasicDeviceFactory<TIVTMDevice>("#/definitions/simple_device", "#/definitions/common_channel"));	576✔
22	}	288✔
23
24	TIVTMDevice::TIVTMDevice(PDeviceConfig config, PProtocol protocol)	2✔
25	: TSerialDevice(config, protocol),
26	TUInt32SlaveId(config->SlaveId)	2✔
27	{}	2✔
28
29	void TIVTMDevice::WriteCommand(TPort& port, uint16_t addr, uint16_t data_addr, uint8_t data_len)	6✔
30	{
31	port.CheckPortOpen();	6✔
32	uint8_t buf[16];
33	buf[0] = '$';	6✔
34
35	snprintf((char*)&buf[1], 3, "%02X", addr >> 8);	6✔
36	snprintf((char*)&buf[3], 3, "%02X", addr & 0xFF);	6✔
37
38	buf[5] = 'R';	6✔
39	buf[6] = 'R';	6✔
40
41	snprintf((char*)&buf[7], 3, "%02X", data_addr >> 8);	6✔
42	snprintf((char*)&buf[9], 3, "%02X", data_addr & 0xFF);	6✔
43
44	snprintf((char*)&buf[11], 3, "%02X", data_len);	6✔
45
46	uint8_t crc8 = 0;	6✔
47	for (size_t i = 0; i < 13; ++i) {	84✔
48	crc8 += buf[i];	78✔
49	}
50
51	snprintf((char*)&buf[13], 3, "%02X", crc8);	6✔
52	buf[15] = 0x0d;	6✔
53
54	port.WriteBytes(buf, 16);	6✔
55	}	6✔
56
57	static const int MAX_LEN = 100;
58
59	bool TIVTMDevice::DecodeASCIIBytes(uint8_t* buf, uint8_t* result, uint8_t len_bytes)	12✔
60	{
61	for (size_t i = 0; i < len_bytes; ++i) {	48✔
62	result[i] = DecodeASCIIByte(buf + i * 2);	36✔
63	}
64	return true;	12✔
65	}
66
67	uint8_t TIVTMDevice::DecodeASCIIByte(uint8_t* buf)	42✔
68	{
69	std::string s(buf, buf + 2);	42✔
70	return stoul(s, nullptr, 16);	84✔
71	}
72
73	uint16_t TIVTMDevice::DecodeASCIIWord(uint8_t* buf)	6✔
74	{
75	uint8_t decoded_buf[2];
76	DecodeASCIIBytes(buf, decoded_buf, 2);	6✔
77
78	return (decoded_buf[0] << 8) \| decoded_buf[1];	6✔
79	}
80
81	void TIVTMDevice::ReadResponse(TPort& port, uint16_t addr, uint8_t* payload, uint16_t len)	6✔
82	{
83	uint8_t buf[MAX_LEN];
84
85	auto nread = port.ReadFrame(buf,	6✔
86	MAX_LEN,
87	GetResponseTimeout(port),	×
88	GetFrameTimeout(port),	6✔
89	[](uint8_t* buf, int size) { return size > 0 && buf[size - 1] == '\r'; })	120✔
90	.Count;	6✔
91	if (nread < 10)	6✔
92	throw TSerialDeviceTransientErrorException("frame too short");	×
93
94	if ((buf[0] != '!') \|\| (buf[5] != 'R') \|\| (buf[6] != 'R')) {	6✔
95	throw TSerialDeviceTransientErrorException("invalid response header");	×
96	}
97
98	if (buf[nread - 1] != 0x0D) {	6✔
99	throw TSerialDeviceTransientErrorException("invalid response footer");	×
100	}
101
102	if (DecodeASCIIWord(&buf[1]) != addr) {	6✔
103	throw TSerialDeviceTransientErrorException("invalid slave addr in response");	×
104	}
105
106	uint8_t crc8 = 0;	6✔
107	for (size_t i = 0; i < (size_t)nread - 3; ++i) {	96✔
108	crc8 += buf[i];	90✔
109	}
110
111	uint8_t actualCrc = DecodeASCIIByte(&buf[nread - 3]);	6✔
112
113	if (crc8 != actualCrc)	6✔
114	throw TSerialDeviceTransientErrorException("invalid crc");	×
115
116	int actualPayloadSize = nread - 10; // in ASCII symbols	6✔
117	if (len * 2 != actualPayloadSize) {	6✔
118	throw TSerialDeviceTransientErrorException("unexpected frame size");	×
119	} else {
120	len = actualPayloadSize / 2;	6✔
121	}
122
123	DecodeASCIIBytes(buf + 7, payload, len);	6✔
124	}	6✔
125
126	TRegisterValue TIVTMDevice::ReadRegisterImpl(TPort& port, const TRegisterConfig& reg)	6✔
127	{
128	port.SkipNoise();	6✔
129
130	auto addr = GetUint32RegisterAddress(reg.GetAddress());	6✔
131	WriteCommand(port, SlaveId, addr, reg.GetByteWidth());	6✔
132	uint8_t response[4];
133	ReadResponse(port, SlaveId, response, reg.GetByteWidth());	6✔
134
135	uint8_t* p = response; //&response[(address % 2) * 4];	6✔
136
137	// the response is little-endian. We inverse the byte order here to make it big-endian.
138
139	return TRegisterValue{static_cast<uint64_t>((p[3] << 24) \| (p[2] << 16) \| (p[1] << 8) \| p[0])};	12✔
140	}
141
142	#if 0
143	int main(int, char**)
144	{
145	try {
146	TIVTMDevice bus("/dev/ttyNSC1");
147	bus.Open();
148	int v = bus.ReadRegister(0x01, 0x0a);
149	std::cout << "value of mod 0x01 reg 0x0a: " << v << std::endl;
150	for (int i = 0; i < 8; ++i) {
151	bus.WriteRegister(0x01, 0x02 + i, 0x00); // manual control of the channel (low threshold = 0)
152	int address = 0x1a + i;
153	std::cout << "value of relay " << i << ": " << (int)bus.ReadRegister(0x01, address) << std::endl;
154	bus.WriteRegister(0x01, address, 0xff);
155	std::cout << "value of relay " << i << " (on): " << (int)bus.ReadRegister(0x01, address) << std::endl;
156	sleep(1);
157	bus.WriteRegister(0x01, address, 0x00);
158	std::cout << "value of relay " << i << " (off): " << (int)bus.ReadRegister(0x01, address) << std::endl;
159	}
160	} catch (const TIVTMDeviceException& e) {
161	std::cerr << "uniel bus error: " << e.what() << std::endl;
162	}
163	return 0;
164	}
165	#endif

wirenboard / wb-mqtt-serial / 2

Source File Press 'n' to go to next uncovered line, 'b' for previous

Source File
Press 'n' to go to next uncovered line, 'b' for previous