|
| 1 | +#include "app/core/checksum_utils.h" |
| 2 | + |
| 3 | +#include <QtCore/QtGlobal> |
| 4 | + |
| 5 | +namespace { |
| 6 | + |
| 7 | +const QList<AppChecksum::AlgorithmOption> & algorithmOptions() |
| 8 | +{ |
| 9 | + static const QList<AppChecksum::AlgorithmOption> options = { |
| 10 | + {QStringLiteral("crc16-modbus"), QStringLiteral("CRC16-Modbus"), 2}, |
| 11 | + {QStringLiteral("crc16-ccitt"), QStringLiteral("CRC16-CCITT"), 2}, |
| 12 | + {QStringLiteral("crc32"), QStringLiteral("CRC32"), 4}, |
| 13 | + {QStringLiteral("lrc"), QStringLiteral("LRC"), 1}, |
| 14 | + {QStringLiteral("xor"), QStringLiteral("XOR"), 1}, |
| 15 | + {QStringLiteral("sum8"), QStringLiteral("SUM8"), 1}, |
| 16 | + }; |
| 17 | + return options; |
| 18 | +} |
| 19 | + |
| 20 | +const AppChecksum::AlgorithmOption &optionForKey(const QString &key) |
| 21 | +{ |
| 22 | + const QString normalized = AppChecksum::normalizedAlgorithmKey(key); |
| 23 | + for (const AppChecksum::AlgorithmOption &option : algorithmOptions()) { |
| 24 | + if (option.key == normalized) { |
| 25 | + return option; |
| 26 | + } |
| 27 | + } |
| 28 | + return algorithmOptions().first(); |
| 29 | +} |
| 30 | + |
| 31 | +quint16 crc16Modbus(const QByteArray &data) |
| 32 | +{ |
| 33 | + quint16 crc = 0xFFFF; |
| 34 | + for (unsigned char byte : data) { |
| 35 | + crc ^= byte; |
| 36 | + for (int i = 0; i < 8; ++i) { |
| 37 | + if ((crc & 0x0001) != 0) { |
| 38 | + crc = static_cast<quint16>((crc >> 1) ^ 0xA001); |
| 39 | + } else { |
| 40 | + crc = static_cast<quint16>(crc >> 1); |
| 41 | + } |
| 42 | + } |
| 43 | + } |
| 44 | + return crc; |
| 45 | +} |
| 46 | + |
| 47 | +quint16 crc16CcittFalse(const QByteArray &data) |
| 48 | +{ |
| 49 | + quint16 crc = 0xFFFF; |
| 50 | + for (unsigned char byte : data) { |
| 51 | + crc ^= static_cast<quint16>(byte << 8); |
| 52 | + for (int i = 0; i < 8; ++i) { |
| 53 | + if ((crc & 0x8000) != 0) { |
| 54 | + crc = static_cast<quint16>((crc << 1) ^ 0x1021); |
| 55 | + } else { |
| 56 | + crc = static_cast<quint16>(crc << 1); |
| 57 | + } |
| 58 | + } |
| 59 | + } |
| 60 | + return crc; |
| 61 | +} |
| 62 | + |
| 63 | +quint32 crc32Ieee(const QByteArray &data) |
| 64 | +{ |
| 65 | + quint32 crc = 0xFFFFFFFFU; |
| 66 | + for (unsigned char byte : data) { |
| 67 | + crc ^= byte; |
| 68 | + for (int i = 0; i < 8; ++i) { |
| 69 | + if ((crc & 0x00000001U) != 0) { |
| 70 | + crc = (crc >> 1) ^ 0xEDB88320U; |
| 71 | + } else { |
| 72 | + crc >>= 1; |
| 73 | + } |
| 74 | + } |
| 75 | + } |
| 76 | + return crc ^ 0xFFFFFFFFU; |
| 77 | +} |
| 78 | + |
| 79 | +quint8 lrc(const QByteArray &data) |
| 80 | +{ |
| 81 | + quint8 sum = 0; |
| 82 | + for (unsigned char byte : data) { |
| 83 | + sum = static_cast<quint8>(sum + byte); |
| 84 | + } |
| 85 | + return static_cast<quint8>(0U - sum); |
| 86 | +} |
| 87 | + |
| 88 | +quint8 xor8(const QByteArray &data) |
| 89 | +{ |
| 90 | + quint8 result = 0; |
| 91 | + for (unsigned char byte : data) { |
| 92 | + result ^= byte; |
| 93 | + } |
| 94 | + return result; |
| 95 | +} |
| 96 | + |
| 97 | +quint8 sum8(const QByteArray &data) |
| 98 | +{ |
| 99 | + quint8 result = 0; |
| 100 | + for (unsigned char byte : data) { |
| 101 | + result = static_cast<quint8>(result + byte); |
| 102 | + } |
| 103 | + return result; |
| 104 | +} |
| 105 | + |
| 106 | +QByteArray valueBytes(quint32 value, int widthBytes, AppChecksum::ByteOrder byteOrder) |
| 107 | +{ |
| 108 | + QByteArray bytes; |
| 109 | + bytes.reserve(widthBytes); |
| 110 | + if (byteOrder == AppChecksum::ByteOrder::LittleEndian) { |
| 111 | + for (int i = 0; i < widthBytes; ++i) { |
| 112 | + bytes.append(static_cast<char>((value >> (8 * i)) & 0xFF)); |
| 113 | + } |
| 114 | + return bytes; |
| 115 | + } |
| 116 | + |
| 117 | + for (int i = widthBytes - 1; i >= 0; --i) { |
| 118 | + bytes.append(static_cast<char>((value >> (8 * i)) & 0xFF)); |
| 119 | + } |
| 120 | + return bytes; |
| 121 | +} |
| 122 | + |
| 123 | +} // namespace |
| 124 | + |
| 125 | +namespace AppChecksum { |
| 126 | + |
| 127 | +QList<AlgorithmOption> options() { return algorithmOptions(); } |
| 128 | + |
| 129 | +QString defaultAlgorithmKey() { return QStringLiteral("crc16-modbus"); } |
| 130 | + |
| 131 | +QString normalizedAlgorithmKey(const QString &key) |
| 132 | +{ |
| 133 | + const QString normalized = key.trimmed().toLower(); |
| 134 | + if (normalized == QStringLiteral("modbus") || normalized == QStringLiteral("crc-modbus")) { |
| 135 | + return QStringLiteral("crc16-modbus"); |
| 136 | + } |
| 137 | + if (normalized == QStringLiteral("ccitt") || normalized == QStringLiteral("crc16")) { |
| 138 | + return QStringLiteral("crc16-ccitt"); |
| 139 | + } |
| 140 | + if (normalized == QStringLiteral("sum")) { |
| 141 | + return QStringLiteral("sum8"); |
| 142 | + } |
| 143 | + |
| 144 | + for (const AlgorithmOption &option : algorithmOptions()) { |
| 145 | + if (option.key == normalized) { |
| 146 | + return option.key; |
| 147 | + } |
| 148 | + } |
| 149 | + return defaultAlgorithmKey(); |
| 150 | +} |
| 151 | + |
| 152 | +QString labelForAlgorithm(const QString &key) { return optionForKey(key).label; } |
| 153 | + |
| 154 | +int widthForAlgorithm(const QString &key) { return optionForKey(key).widthBytes; } |
| 155 | + |
| 156 | +ByteOrder byteOrderFromKey(const QString &key) |
| 157 | +{ |
| 158 | + return key.trimmed().toLower() == QStringLiteral("big") ? ByteOrder::BigEndian : ByteOrder::LittleEndian; |
| 159 | +} |
| 160 | + |
| 161 | +QString byteOrderKey(ByteOrder byteOrder) |
| 162 | +{ |
| 163 | + return byteOrder == ByteOrder::BigEndian ? QStringLiteral("big") : QStringLiteral("little"); |
| 164 | +} |
| 165 | + |
| 166 | +QString byteOrderLabel(ByteOrder byteOrder) |
| 167 | +{ |
| 168 | + return byteOrder == ByteOrder::BigEndian ? QStringLiteral("高字节在前") : QStringLiteral("低字节在前"); |
| 169 | +} |
| 170 | + |
| 171 | +ChecksumResult calculate(const QByteArray &data, const QString &algorithmKey, ByteOrder byteOrder) |
| 172 | +{ |
| 173 | + ChecksumResult result; |
| 174 | + const QString key = normalizedAlgorithmKey(algorithmKey); |
| 175 | + const int widthBytes = widthForAlgorithm(key); |
| 176 | + |
| 177 | + if (key == QStringLiteral("crc16-modbus")) { |
| 178 | + result.value = crc16Modbus(data); |
| 179 | + } else if (key == QStringLiteral("crc16-ccitt")) { |
| 180 | + result.value = crc16CcittFalse(data); |
| 181 | + } else if (key == QStringLiteral("crc32")) { |
| 182 | + result.value = crc32Ieee(data); |
| 183 | + } else if (key == QStringLiteral("lrc")) { |
| 184 | + result.value = lrc(data); |
| 185 | + } else if (key == QStringLiteral("xor")) { |
| 186 | + result.value = xor8(data); |
| 187 | + } else if (key == QStringLiteral("sum8")) { |
| 188 | + result.value = sum8(data); |
| 189 | + } else { |
| 190 | + result.errorMessage = QStringLiteral("不支持的校验算法"); |
| 191 | + return result; |
| 192 | + } |
| 193 | + |
| 194 | + result.bytes = valueBytes(result.value, widthBytes, byteOrder); |
| 195 | + result.ok = true; |
| 196 | + return result; |
| 197 | +} |
| 198 | + |
| 199 | +} // namespace AppChecksum |
0 commit comments