| | |
| | | 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; |
| | | } |
| | | } |