| | |
| | | package com.ard.utils.tcp; |
| | | |
| | | import com.ard.utils.SpringTool; |
| | | import io.netty.buffer.ByteBuf; |
| | | import io.netty.channel.ChannelHandlerContext; |
| | | import io.netty.channel.SimpleChannelInboundHandler; |
| | | import lombok.extern.slf4j.Slf4j; |
| | | import sun.nio.cs.ext.GBK; |
| | | |
| | | import javax.xml.bind.DatatypeConverter; |
| | | import java.nio.charset.Charset; |
| | | import java.nio.charset.StandardCharsets; |
| | | import java.text.SimpleDateFormat; |
| | | import java.util.*; |
| | | |
| | | /** |
| | | * @Description: tcp客户端处理 |
| | |
| | | * @Date: 2023年06月25日17:02 |
| | | * @Version: 1.0 |
| | | **/ |
| | | @Slf4j |
| | | @Slf4j(topic = "radar") |
| | | public class NettyTcpClientHandler extends SimpleChannelInboundHandler<ByteBuf> { |
| | | |
| | | @Override |
| | | protected void channelRead0(ChannelHandlerContext ctx, ByteBuf msg){ |
| | | protected void channelRead0(ChannelHandlerContext ctx, ByteBuf msg) { |
| | | // 处理接收到的消息 |
| | | byte[] byteArray = new byte[msg.readableBytes()]; |
| | | msg.getBytes(msg.readerIndex(), byteArray); |
| | | String hexString = DatatypeConverter.printHexBinary(byteArray); |
| | | |
| | | log.info("Received: " + hexString); |
| | | byte[] bytes = receiveCompletePacket(byteArray); |
| | | if (bytes != null) { |
| | | String hexString = DatatypeConverter.printHexBinary(bytes); |
| | | log.info(hexString); |
| | | processData(bytes); |
| | | } |
| | | } |
| | | |
| | | @Override |
| | | public void channelActive(ChannelHandlerContext ctx) throws Exception { |
| | | public void channelActive(ChannelHandlerContext ctx) { |
| | | // 当客户端连接成功后,发送消息给服务器 |
| | | ByteBuf message = ctx.alloc().buffer(); |
| | | message.writeBytes("Hello, Server!".getBytes()); |
| | | ctx.writeAndFlush(message); |
| | | TimerTask timerTask = new TimerTask() { |
| | | @Override |
| | | public void run() { |
| | | ByteBuf message = ctx.alloc().buffer(); |
| | | byte[] heart = {0x01, 0x02, 0x01, 0x10, 0x00, 0x00, 0x00, (byte) 0x83, (byte) 0x88, 0x5d, 0x71, 0x01, 0x02, 0x00}; |
| | | String hexString = DatatypeConverter.printHexBinary(heart); |
| | | log.info("发送心跳:" + hexString); |
| | | message.writeBytes(heart); |
| | | ctx.writeAndFlush(message); |
| | | } |
| | | }; |
| | | Timer timer = new Timer(); |
| | | // timer.schedule(timerTask, 0, 6000); |
| | | } |
| | | |
| | | @Override |
| | | public void exceptionCaught(ChannelHandlerContext ctx, Throwable cause){ |
| | | public void exceptionCaught(ChannelHandlerContext ctx, Throwable cause) { |
| | | log.error("连接异常"); |
| | | // 发生异常时的处理 |
| | | cause.printStackTrace(); |
| | | ctx.close(); |
| | | } |
| | | |
| | | public static void processData(byte[] data) { |
| | | try { |
| | | data = transferData(data);//去掉包头和包尾及转义 |
| | | String s = DatatypeConverter.printHexBinary(data); |
| | | log.info(s); |
| | | byte[] type = Arrays.copyOfRange(data, index.type[0], index.type[1]);//命令类型 |
| | | log.info("命令类型:" + DatatypeConverter.printHexBinary(type)); |
| | | |
| | | byte[] cmdId = Arrays.copyOfRange(data, index.funcc[0], index.funcc[1]);//命令ID |
| | | log.info("命令ID:" + DatatypeConverter.printHexBinary(cmdId)); |
| | | |
| | | byte[] payloadSize = Arrays.copyOfRange(data, index.payloadSize[0], index.payloadSize[1]);//有效负载大小 |
| | | // log.info("有效负载大小:" + DatatypeConverter.printHexBinary(payloadSize)); |
| | | payloadSize = toLittleEndian(payloadSize); |
| | | // log.info("有效负载大小(转小端):" + DatatypeConverter.printHexBinary(payloadSize)); |
| | | int payloadSizeToDecimal = byteArrayToDecimal(payloadSize); |
| | | log.info("有效负载大小(转整型):" + payloadSizeToDecimal); |
| | | |
| | | if (Arrays.equals(cmdId, new byte[]{0x01})) { |
| | | byte[] dwTim = Arrays.copyOfRange(data, index.dwTim[0], index.dwTim[1]); |
| | | // log.info("周视图像的出现时间:" + DatatypeConverter.printHexBinary(dwTim)); |
| | | dwTim = toLittleEndian(dwTim); |
| | | // log.info("周视图像的出现时间(转小端):" + DatatypeConverter.printHexBinary(dwTim)); |
| | | // log.info("周视图像的出现时间(转整型):" + byteArrayToDecimal(dwTim)); |
| | | SimpleDateFormat sdf = new SimpleDateFormat("yyyy-MM-dd HH:mm:ss"); |
| | | long l = byteArrayToDecimal(dwTim); |
| | | String format = sdf.format(l * 1000); |
| | | log.info("周视图像的出现时间(转date):" + format); |
| | | |
| | | byte[] wTargetNum = Arrays.copyOfRange(data, index.wTargetNum[0], index.wTargetNum[1]); |
| | | wTargetNum = toLittleEndian(wTargetNum); |
| | | // log.info("目标总点数(转小端):" + DatatypeConverter.printHexBinary(wTargetNum)); |
| | | int targetNum = byteArrayToDecimal(wTargetNum); |
| | | log.info("目标总点数(转整型):" + targetNum); |
| | | |
| | | //解析NET_TARGET_UNIT(64是NET_TARGET_HEAD的字节数) |
| | | int unitIndex = index.acRes[1]; |
| | | log.info("有效负载无头起始位:" + unitIndex); |
| | | |
| | | // byte datum = data[unitIndex]; |
| | | // log.info("无头起始字节:" + SpringTool.byteToHex(datum)); |
| | | int UNITNum = (payloadSizeToDecimal - 64) / targetNum; |
| | | log.info("单个Unit大小:" + UNITNum); |
| | | for (int i = 0; i < targetNum; i++) { |
| | | Integer index = unitIndex + UNITNum * i; |
| | | byte[] dwID = Arrays.copyOfRange(data, index, index + 4); |
| | | dwID = toLittleEndian(dwID); |
| | | // log.info("dwID:" + DatatypeConverter.printHexBinary(dwID)); |
| | | int id = byteArrayToDecimal(dwID); |
| | | log.info("目标ID号:" + id); |
| | | |
| | | byte[] dwGSum = Arrays.copyOfRange(data, index + 4, index + 8); |
| | | dwGSum = toLittleEndian(dwGSum); |
| | | int GSum = byteArrayToDecimal(dwGSum); |
| | | log.info("目标当前像素灰度和:" + GSum); |
| | | |
| | | byte[] iDistance = Arrays.copyOfRange(data, index + 8, index + 12); |
| | | iDistance = toLittleEndian(iDistance); |
| | | int Distance = byteArrayToDecimal(iDistance); |
| | | log.info("目标当前距离(m):" + Distance); |
| | | |
| | | byte[] iTw = Arrays.copyOfRange(data, index + 12, index + 16); |
| | | iTw = toLittleEndian(iTw); |
| | | int Tw = byteArrayToDecimal(iTw); |
| | | log.info("目标当前的像素宽度:" + Tw); |
| | | |
| | | byte[] iTh = Arrays.copyOfRange(data, index + 16, index + 20); |
| | | iTh = toLittleEndian(iTh); |
| | | int Th = byteArrayToDecimal(iTh); |
| | | log.info("目标当前的像素高度:" + Th); |
| | | |
| | | byte[] wPxlArea = Arrays.copyOfRange(data, index + 20, index + 22); |
| | | wPxlArea = toLittleEndian(wPxlArea); |
| | | int PxlArea = byteArrayToDecimal(wPxlArea); |
| | | log.info("目标当前像素面积:" + PxlArea); |
| | | |
| | | byte[] cTrkNum = Arrays.copyOfRange(data, index + 22, index + 23); |
| | | cTrkNum = toLittleEndian(cTrkNum); |
| | | int TrkNum = byteArrayToDecimal(cTrkNum); |
| | | log.info("轨迹点数:" + TrkNum); |
| | | |
| | | byte[] cStat = Arrays.copyOfRange(data, index + 23, index + 24); |
| | | cStat = toLittleEndian(cStat); |
| | | int Stat = byteArrayToDecimal(cStat); |
| | | log.info("目标当前状态:" + Stat); |
| | | |
| | | byte[] sVx = Arrays.copyOfRange(data, index + 24, index + 26); |
| | | sVx = toLittleEndian(sVx); |
| | | int Vx = byteArrayToDecimal(sVx); |
| | | log.info("目标当前速度矢量(像素距离)X:" + Vx); |
| | | |
| | | byte[] sVy = Arrays.copyOfRange(data, index + 26, index + 28); |
| | | sVy = toLittleEndian(sVy); |
| | | int Vy = byteArrayToDecimal(sVy); |
| | | log.info("目标当前速度矢量(像素距离)Y:" + Vy); |
| | | |
| | | byte[] sAreaNo = Arrays.copyOfRange(data, index + 28, index + 30); |
| | | sAreaNo = toLittleEndian(sAreaNo); |
| | | int AreaNo = byteArrayToDecimal(sAreaNo); |
| | | log.info("目标归属的告警区域号:" + AreaNo); |
| | | |
| | | byte[] cGrp = Arrays.copyOfRange(data, index + 30, index + 31); |
| | | cGrp = toLittleEndian(cGrp); |
| | | int Grp = byteArrayToDecimal(cGrp); |
| | | log.info("所属组:" + Grp); |
| | | |
| | | byte[] szName = Arrays.copyOfRange(data, index + 64, index + 96); |
| | | String str = new String(szName, "GBK"); |
| | | log.info("所属告警区域名称:" + str); |
| | | } |
| | | } |
| | | } catch (Exception ex) { |
| | | log.error(ex.getMessage()); |
| | | } |
| | | } |
| | | |
| | | public static int byteArrayToDecimal(byte[] byteArray) { |
| | | int decimalValue = 0; |
| | | |
| | | for (int i = 0; i < byteArray.length; i++) { |
| | | decimalValue = (decimalValue << 8) | (byteArray[i] & 0xFF); |
| | | } |
| | | |
| | | return decimalValue; |
| | | } |
| | | |
| | | public static byte[] toLittleEndian(byte[] bigEndianBytes) { |
| | | byte[] littleEndianBytes = new byte[bigEndianBytes.length]; |
| | | |
| | | for (int i = 0; i < bigEndianBytes.length; i++) { |
| | | int j = bigEndianBytes.length - i - 1; |
| | | littleEndianBytes[i] = bigEndianBytes[j]; |
| | | } |
| | | |
| | | return littleEndianBytes; |
| | | } |
| | | |
| | | |
| | | public static Integer processPayloadSize(String payloadSize) {//解析有效负载大小 |
| | | Integer payloadSizeInfo = 0; |
| | | String[] payloadSizeArr = payloadSize.split(""); |
| | | for (int i = 0; i <= payloadSizeArr.length - 1; i++) { |
| | | Integer num = null; |
| | | switch (payloadSizeArr[i]) { |
| | | case "0": |
| | | num = 0; |
| | | break; |
| | | case "1": |
| | | num = 1; |
| | | break; |
| | | case "2": |
| | | num = 2; |
| | | break; |
| | | case "3": |
| | | num = 3; |
| | | break; |
| | | case "4": |
| | | num = 4; |
| | | break; |
| | | case "5": |
| | | num = 5; |
| | | break; |
| | | case "6": |
| | | num = 6; |
| | | break; |
| | | case "7": |
| | | num = 7; |
| | | break; |
| | | case "8": |
| | | num = 8; |
| | | break; |
| | | case "9": |
| | | num = 9; |
| | | break; |
| | | case "a": |
| | | num = 10; |
| | | break; |
| | | case "b": |
| | | num = 11; |
| | | break; |
| | | case "c": |
| | | num = 12; |
| | | break; |
| | | case "d": |
| | | num = 13; |
| | | break; |
| | | case "e": |
| | | num = 14; |
| | | break; |
| | | case "f": |
| | | num = 15; |
| | | break; |
| | | default: |
| | | break; |
| | | } |
| | | if (i % 2 == 0) { |
| | | payloadSizeInfo = payloadSizeInfo + num * 16; |
| | | } else { |
| | | payloadSizeInfo = payloadSizeInfo + num * 256; |
| | | } |
| | | } |
| | | return payloadSizeInfo; |
| | | } |
| | | |
| | | public static Boolean checkPayloadSize(Integer payloadSizeInfo, String data) {//校验有效负载大小 |
| | | Integer payloadSize = (data.length() - 8 - 8) / 2;//去除包头8位和校验8位 |
| | | if (payloadSize.equals(payloadSizeInfo)) { |
| | | return true; |
| | | } else { |
| | | return false; |
| | | } |
| | | } |
| | | |
| | | // 创建缓冲区列表 |
| | | List<Byte> buffer = new ArrayList<>(); |
| | | |
| | | public byte[] receiveCompletePacket(byte[] receivedData) { |
| | | // 定义包尾字节序列 |
| | | byte[] packetEnd = {0x01, 0x02, 0x00}; |
| | | // 添加已接收的数据到缓冲区 |
| | | for (byte data : receivedData) { |
| | | buffer.add(data); |
| | | } |
| | | // 检查缓冲区中的数据是否包含完整的包 |
| | | while (buffer.size() >= packetEnd.length) { |
| | | int endIndex = findPacketEndIndex(buffer, packetEnd); |
| | | if (endIndex != -1) { |
| | | // 找到完整的包 |
| | | byte[] packet = extractPacketFromBuffer(buffer, endIndex + packetEnd.length); |
| | | return packet; |
| | | } else { |
| | | // 未找到包尾,继续接收数据 |
| | | break; |
| | | } |
| | | } |
| | | |
| | | // 未找到完整的包 |
| | | return null; |
| | | } |
| | | |
| | | public static int findPacketEndIndex(List<Byte> buffer, byte[] packetEnd) { |
| | | for (int i = 0; i <= buffer.size() - packetEnd.length; i++) { |
| | | boolean isMatch = true; |
| | | for (int j = 0; j < packetEnd.length; j++) { |
| | | if (buffer.get(i + j) != packetEnd[j]) { |
| | | isMatch = false; |
| | | break; |
| | | } |
| | | } |
| | | if (isMatch) { |
| | | return i; |
| | | } |
| | | } |
| | | return -1; |
| | | } |
| | | |
| | | public static byte[] extractPacketFromBuffer(List<Byte> buffer, int endIndex) { |
| | | byte[] packet = new byte[endIndex]; |
| | | for (int i = 0; i < endIndex; i++) { |
| | | packet[i] = buffer.get(i); |
| | | } |
| | | buffer.subList(0, endIndex).clear(); |
| | | return packet; |
| | | } |
| | | |
| | | //去掉包头和包尾校验及转义 |
| | | public static byte[] transferData(byte[] data) { |
| | | data = Arrays.copyOfRange(data, 3, data.length); |
| | | data = Arrays.copyOfRange(data, 0, data.length - 7); |
| | | String dataStr = DatatypeConverter.printHexBinary(data); |
| | | if (dataStr.contains("01020201")) {//转义01020201 |
| | | dataStr = dataStr.replaceAll("01020201", "010201"); |
| | | } |
| | | if (dataStr.contains("01020200")) {//转义01020200 |
| | | dataStr = dataStr.replaceAll("01020200", "010200"); |
| | | } |
| | | if (dataStr.contains("01020202")) {//转义01020202 |
| | | dataStr = dataStr.replaceAll("01020202", "010202"); |
| | | } |
| | | data = DatatypeConverter.parseHexBinary(dataStr); |
| | | return data; |
| | | } |
| | | } |