zhangnaisong
2024-08-05 ae64126733bedc1a15a0177b105fec7f499ada81
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
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
342
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
361
/**
 * <p>Description: </p>
 * <p>Copyright: Copyright (c) 2020</p>
 * <p>Company: www.31gps.net</p>
 * @author chencq
 * @version 1.0
 */
package com.ruoyi.sy.gps31;
 
import com.alibaba.fastjson2.JSON;
import com.gps31.push.netty.PushClient;
import com.gps31.push.netty.PushMsg;
import com.gps31.push.netty.client.TcpClient;
import com.gps31.push.util.MapUtil;
import com.ruoyi.common.utils.spring.SpringUtils;
import com.ruoyi.sy.domain.*;
import com.ruoyi.sy.service.*;
import com.ruoyi.sy.service.impl.*;
import com.ruoyi.utils.gps.GeoTools;
import com.ruoyi.utils.qymqtt.newM.EmqClient;
import com.ruoyi.utils.qymqtt.newM.QosEnum;
import com.ruoyi.utils.qymqtt.oldM.MqttCustomerClient;
import lombok.extern.slf4j.Slf4j;
import org.apache.commons.logging.Log;
import org.apache.commons.logging.LogFactory;
import org.eclipse.paho.client.mqttv3.MqttException;
 
import java.awt.geom.Point2D;
import java.math.BigDecimal;
import java.text.SimpleDateFormat;
import java.util.*;
 
/**
 * <p>Description: </p>
 * <p>Copyright: Copyright (c) 2020</p>
 * <p>Company: www.31gps.net</p>
 * @author chencq
 * @version 1.0
 */
@Slf4j(topic = "mqttCar")
public class PushClientImplPosition extends PushClient implements Runnable {
 
//    private static final Log log = LogFactory.getLog(PushClientImplPosition.class);
 
    private String ip;
 
    private String userId;
 
    private String password;
 
    public PushClientImplPosition(String ip, String userId, String password) {
        this.ip = ip;
        this.userId = userId;
        this.password = password;
    }
 
    public PushClientImplPosition() {
 
    }
 
    @Override
    public void messageReceived(TcpClient tcpClient, PushMsg pushMsg)
            throws Exception {
        if("8001".equals(pushMsg.getCmd())) {//登录应答
            String rspResult = MapUtil.getStrVal(pushMsg.getJsonMap(),"rspResult","1");
            if("0".equals(rspResult)) {//登录成功,定阅动态消息
                Map<String,Object> map = new HashMap<String,Object>();
                map.put("seq", "1");
                map.put("action", "add");
                map.put("msgIds", JSON.toJSONString(getSubCmdSet()));
                PushMsg subMsg = getInstance("0003",map);
                sendMsg(subMsg);
            }
        }else if("8002".equals(pushMsg.getCmd())){//心跳应答
 
        }else if("8003".equals(pushMsg.getCmd())){//订阅动态消息应答
            String rspResult = MapUtil.getStrVal(pushMsg.getJsonMap(),"rspResult","1");
            //log.error(String.format("    订阅应答:%s", "0".equals(rspResult)?"成功":"失败"));
        }else if("0200".equals(pushMsg.getCmd())) {//定位信息
            Map<String,Object> gpsMap = pushMsg.getJsonMap();
            /*String carName = MapUtil.getStrVal(gpsMap, "carName","");//获取车牌号
            SimpleDateFormat sdf = new SimpleDateFormat("yyyy-MM-dd HH:mm:ss");
            System.out.println(sdf.format(new Date()));*/
            log.debug(String.format("   ---->----收到定位数据如下:%s",JSON.toJSONString(gpsMap)));
            String carId = (String)gpsMap.get("carId");
            ((ArdSyCarDayServiceImpl)SpringUtils.getBean("ardSyCarDayServiceImpl")).insertArdSyCarDay(carId);//新增车辆上报时间
            Map<String,Object> result = ((ArdSyCarServiceImpl)SpringUtils.getBean("ardSyCarServiceImpl")).getArdSyCarAndDeptByCarId(carId);//查询车辆及部门
            if(result != null){
 
                if(PositionContainer.getTankCarParkingAlarmTHread().get(carId) == null){//异常停车线程
                    Thread tankCarParkingAlarmThread = new Thread(){//创建线程判断罐车异常停车报警
                        @Override
                        public void run() {
                            ((ArdTankAbnormalParkAlarmServiceImpl)SpringUtils.getBean("ardTankAbnormalParkAlarmServiceImpl")).insertArdTankAbnormalParkAlarm(gpsMap);
                        }
                    };
                    PositionContainer.getTankCarParkingAlarmTHread().put(carId,tankCarParkingAlarmThread);
                    tankCarParkingAlarmThread.start();
                }
 
 
                Thread autoProcessThread = new Thread(){//自动操控线程
                    @Override
                    public void run() {
                        ((ArdTankLockProcessLogServiceImpl)SpringUtils.getBean("ardTankLockProcessLogServiceImpl")).autoProcessArdTankLockByLockId(gpsMap);
                    }
                };
                autoProcessThread.start();
 
                gpsMap.putAll(result);
                String ancestors = (String) gpsMap.get("ancestors");//获取父级部门
                String[] ancestorsArray = ancestors.split(",");
                if(ancestorsArray.length == 1){//最高级部门
                    String deptId = String.valueOf(gpsMap.get("deptId"));
                    Map<String,Map<String,Object>> deptMap = PositionContainer.getDeptPositionMap().get(deptId);
                    if(deptMap == null){
                        deptMap = new HashMap();
                        deptMap.put((String)gpsMap.get("carId"),gpsMap);
                        PositionContainer.getDeptPositionMap().put(deptId,deptMap);
                    }else{
                        deptMap.put((String)gpsMap.get("carId"),gpsMap);
                    }
                }else{//其他部门
                    //加入本部门容器
                    String deptId = String.valueOf(gpsMap.get("deptId"));
                    Map<String,Map<String,Object>> deptMap = PositionContainer.getDeptPositionMap().get(deptId);
                    if(deptMap == null){
                        deptMap = new HashMap();
                        deptMap.put((String)gpsMap.get("carId"),gpsMap);
                        PositionContainer.getDeptPositionMap().put(deptId,deptMap);
                    }else{
                        deptMap.put((String)gpsMap.get("carId"),gpsMap);
                    }
                    //加入父级部门容器
                    for(int i = 1;i <= ancestorsArray.length - 1;i++){
                        String deptIdp = ancestorsArray[i];
                        Map<String,Map<String,Object>> deptMapp = PositionContainer.getDeptPositionMap().get(deptIdp);
                        if(deptMapp == null){
                            deptMapp = new HashMap();
                            deptMapp.put((String)gpsMap.get("carId"),gpsMap);
                            PositionContainer.getDeptPositionMap().put(deptIdp,deptMapp);
                        }else{
                            deptMapp.put((String)gpsMap.get("carId"),gpsMap);
                        }
                    }
                }
                //若有用户需要追踪车辆,则计算预估位置
                if(PositionContainer.getUserPositionMap().size() != 0){
                    for(String userId : PositionContainer.getUserPositionMap().keySet()){
                        Map<String,Map<String,Object>> carIdCarMap =  PositionContainer.getUserPositionMap().get(userId);
                        if(carIdCarMap != null){
                            if(carIdCarMap.keySet().contains(carId)){
                                if(PositionContainer.getCarPositionMap().get(carId) == null){
                                    gpsMap.put("elng",gpsMap.get("lng"));
                                    gpsMap.put("elat",gpsMap.get("lat"));
                                }else{
                                    Double velocityOld = ((Integer) PositionContainer.getCarPositionMap().get(carId).get("speed")).doubleValue();
                                    Double velocityNew = ((Integer) gpsMap.get("speed")).doubleValue();
                                    Double acceleration = Double.valueOf(1000*(velocityNew - velocityOld)/3600);
                                    Double distance = getDistance(velocityNew, acceleration ,"1.5");
                                    Double[] eposition = azimuth_offset(((BigDecimal)gpsMap.get("lng")).doubleValue(),((BigDecimal)gpsMap.get("lat")).doubleValue(),(Integer)gpsMap.get("drct"),distance);
                                    gpsMap.put("elng",eposition[0]);
                                    gpsMap.put("elat",eposition[1]);
                                }
                            }
                        }
                    }
                }
                //存入实时位置容器
                PositionContainer.getCarPositionMap().put(carId,gpsMap);
                //存入用户容器
                if(PositionContainer.getUserPositionMap().size() != 0){
                    for(String userId : PositionContainer.getUserPositionMap().keySet()){
                        Map<String,Map<String,Object>> carIdCarMap =  PositionContainer.getUserPositionMap().get(userId);
                        if(carIdCarMap != null){
                            if(carIdCarMap.keySet().contains(carId)){
                                PositionContainer.getUserPositionMap().get(userId).put(carId,gpsMap);
                            }
                        }
                    }
                }
            }
            /**
             *
             * 请加入三方集成方的业务逻辑
             *
             */
        }else if("0300".equals(pushMsg.getCmd())) {//报警消息
            Map<String,Object> alarmMap = pushMsg.getJsonMap();
            String carName = MapUtil.getStrVal(alarmMap, "carName","");//获取车牌号
            //log.error(String.format("   ---->收到报警数据:%s",JSON.toJSONString(alarmMap)));
            /**
             *
             * 请加入三方集成方的业务逻辑
             *
             */
        }else if("0401".equals(pushMsg.getCmd())) {//透传消息
            Map<String,Object> dataMap = pushMsg.getJsonMap();
            String carName = MapUtil.getStrVal(dataMap, "carName","");//获取车牌号
            //log.error(String.format("   ---->收到透传数据:%s",JSON.toJSONString(dataMap)));
            /**
             *
             * 请加入三方集成方的业务逻辑
             *
             */
        }
    }
 
    public void sendMassage() {
        try {
            PushClientImplPosition client = new PushClientImplPosition();
            client.setLog(false);//是否打印明文
            client.setHost(this.ip);//服务器IP
            client.setPort(10100);//服务器端口
            client.setUserName(this.userId);//系统用户名
            client.setPwd(this.password);//系统用户密码
            client.setSubMsgIds("0200");//订阅的动态消息,多个动态消息使用|辟分,当前示例是订阅  定位消息(0x0200)和报警消息(0x0300)
            client.setDesc("测试客户端");//客户端的描述,
            client.start();
            while(true) {
                Thread.sleep(1000);
            }
        } catch (Exception e) {
            e.printStackTrace();
        }
    }
 
    @Override
    public void run() {
        sendMassage();
    }
 
    private void feng(String carId,String type,ArdSyCarRtuService carRtuService,ArdSyCarLockService lockService) throws MqttException {
        //查询装油点既定Rtu状态
        ArdSyCarRtu ardSyCarRtu = carRtuService.one(carId);
        if(ardSyCarRtu!=null){
            //查询锁信息
            List<ArdSyCarLock> ardSyCarLocks = lockService.carLock(ardSyCarRtu.getId());
            if(ardSyCarLocks.size()>0){
                Integer fengType = null;
                if("装油点".equals(type)){
                    fengType = ardSyCarRtu.getInstallType();
                }else if("卸油点".equals(type)){
                    fengType = ardSyCarRtu.getUnloadType();
                }else if("施封".equals(type)){
                    fengType = 0;
                }
                //1解封
                if(fengType==1){
                    //如果不是解封封状态,则发送施封命令
                    if(ardSyCarLocks.get(0).getRelayInfo()==0 || ardSyCarLocks.get(0).getRelayInfo()==null){
//                            Map<String,Object> map = new HashMap<>();
//                            map.put("A01", 110000);//导通第一路继电器
//                            map.put("A02", 110000);//导通第二路继电器
//                            map.put("res", String.valueOf(System.currentTimeMillis()));
//                            String mapString = com.alibaba.fastjson.JSON.toJSONString(map);
                        String mapString = "{\"A01\":110000,\"A02\":110000,\"res\":\""+String.valueOf(System.currentTimeMillis())+"\"}";
                        log.debug("自动解封:"+mapString);
                        EmqClient emqClient = new EmqClient(carId+"mqttPublish"+UUID.randomUUID());
                        emqClient.connect();
                        emqClient.publish(ardSyCarRtu.getTopicPublish(),mapString, QosEnum.QoS2,false);
                        log.debug("车辆"+carId+"解封命令发送成功!");
                        //                mqttOnce.publishCar(carId,ardSyCarRtu.getTopicPublish(),String.valueOf(new JSONObject(map)),"解封");
                    }
                }
 
                //0施封
                if(fengType==0){
                    if(ardSyCarLocks.get(0).getRelayInfo()==1 || ardSyCarLocks.get(0).getRelayInfo()==null){
                        //锁开关状态
                        int lockCloseNum = 0;
                        String mapString1 = "{\"A01\":100000,\"A02\":100000,\"res\":\""+String.valueOf(System.currentTimeMillis())+"\"}";
                        System.out.println("自动施封:"+mapString1);
                        EmqClient emqClient1 = new EmqClient(carId+"mqttPublish"+UUID.randomUUID());
                        emqClient1.connect();
                        emqClient1.publish(ardSyCarRtu.getTopicPublish(),mapString1, QosEnum.QoS2,false);
                        //如果不是施封状态,则发送施封命令
                        if(ardSyCarLocks.get(0).getRelayInfo()!=null){
                            if(ardSyCarLocks.get(0).getRelayInfo()==1){
                                for (int j = 0; j < ardSyCarLocks.size(); j++) {
                                    ArdSyCarLock ardSyCarLock = ardSyCarLocks.get(j);
                                    String currents = ardSyCarLock.getCurrents();
                                    Double currentInfo = ardSyCarLock.getCurrentInfo();
                                    //电流值为4.0是关锁状态
                                    if(currentInfo.equals(4.00) || currentInfo.equals(4)){
                                        lockCloseNum += 1;
                                    }else {
                                        String key = "";
                                        if(currents.equals("C01")){
                                            key = "D03";
                                        }else if(currents.equals("C02")){
                                            key = "D04";
                                        }
//                                    Map<String,Object> map = new HashMap();
//                                    map.put(key, 0.01);
//                                    map.put("res", String.valueOf(System.currentTimeMillis()));
//                                    String mapString = com.alibaba.fastjson.JSON.toJSONString(map);
                                        String mapString = "{\""+key+"\":0.01,\"res\":\""+String.valueOf(System.currentTimeMillis())+"\"}";
                                        log.debug("自动关锁:"+mapString);
                                        EmqClient emqClient = new EmqClient(carId+"mqttPublish"+UUID.randomUUID());
                                        emqClient.connect();
                                        emqClient.publish(ardSyCarRtu.getTopicPublish(),mapString, QosEnum.QoS2,false);
                                        //                        mqttOnce.publishCar("carId",ardSyCarRtu.getTopicPublish(),String.valueOf(new JSONObject(map)),"开锁:"+currents);
                                        while(true){
                                            ArdSyCarLock ardSyCarLock1 = lockService.getCurrentInfo(ardSyCarRtu.getId(),currents);
                                            Double currentInfo1 = ardSyCarLock1.getCurrentInfo();
                                            if(currentInfo1.equals(4.00) || currentInfo1.equals(4)){
                                                lockCloseNum +=1;
                                                break;
                                            }
                                        }
                                    }
                                }
                                if(lockCloseNum == 2){
//                                Map<String,Object> map = new HashMap<>();
//                                map.put("A01", 100000);//断开第一路继电器
//                                map.put("A02", 100000);//断开第二路继电器
//                                map.put("res", String.valueOf(System.currentTimeMillis()));
//                                String mapString = com.alibaba.fastjson.JSON.toJSONString(map);
                                    log.debug("车辆"+carId+"施封命令发送成功!");
                                    //                    mqttOnce.publishCar(carId,ardSyCarRtu.getTopicPublish(),String.valueOf(new JSONObject(map)),"施封");
                                }
                            }
                        }
                    }
                }
            }
        }
    }
 
    public Double[] azimuth_offset(double origin_lon, double origin_lat, Integer direction,double distance){
        Double[] lonlat = new Double[2];
        if(direction != null && distance > 0){
            lonlat[0] = origin_lon + distance * Math.sin(direction* Math.PI / 180) * 180 / ( Math.PI * 6371229 * Math.cos(origin_lat * Math.PI / 180));
            lonlat[1] = origin_lat + distance * Math.cos(direction* Math.PI / 180) / ( Math.PI * 6371229 / 180);
        }else{
            lonlat[0] = origin_lon;
            lonlat[1] = origin_lat;
        }
        return lonlat;
    }
 
    public Double getDistance(Double velocity ,Double acceleration ,String time){
        Double distance = velocity*Double.parseDouble(time) + 0.5*acceleration*Double.parseDouble(time)*Double.parseDouble(time);
        return distance;
    }
 
    /*public Double getVelocity(Double velocity ,Double acceleration ,String time){
        SimpleDateFormat simpleDateFormat = new SimpleDateFormat("yyyy-MM-dd HH:mm:ss");
        Long t = (long) 0;
        try {
            t = (new Date().getTime() - simpleDateFormat.parse(time).getTime())/1000;
        } catch (Exception e) {
            // TODO Auto-generated catch block
            e.printStackTrace();
        }
        Double velocityt = velocity + acceleration*t;
        return velocityt;
    }*/
 
}