liusuyi
2024-10-10 38f29e38fcc668171dc05c53d40a36b895c86102
ard-work/src/main/java/com/ruoyi/sy/gps31/PushClientImplPosition.java
@@ -12,13 +12,23 @@
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.Date;
import java.util.HashMap;
import java.util.Map;
import java.util.*;
/**
 * <p>Description: </p>
@@ -27,9 +37,10 @@
 * @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 static final Log log = LogFactory.getLog(PushClientImplPosition.class);
    private String ip;
@@ -64,13 +75,111 @@
        }else if("8003".equals(pushMsg.getCmd())){//订阅动态消息应答
            String rspResult = MapUtil.getStrVal(pushMsg.getJsonMap(),"rspResult","1");
            log.error(String.format("    订阅应答:%s", "0".equals(rspResult)?"成功":"失败"));
            //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","");//获取车牌号
            /*String carName = MapUtil.getStrVal(gpsMap, "carName","");//获取车牌号
            SimpleDateFormat sdf = new SimpleDateFormat("yyyy-MM-dd HH:mm:ss");
            System.out.println(sdf.format(new Date()));
            log.error(String.format("   ---->收到定位数据:%s",JSON.toJSONString(gpsMap)));
            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);
                            }
                        }
                    }
                }
            }
            /**
             *
             * 请加入三方集成方的业务逻辑
@@ -79,7 +188,7 @@
        }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)));
            //log.error(String.format("   ---->收到报警数据:%s",JSON.toJSONString(alarmMap)));
            /**
             *
             * 请加入三方集成方的业务逻辑
@@ -88,7 +197,7 @@
        }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)));
            //log.error(String.format("   ---->收到透传数据:%s",JSON.toJSONString(dataMap)));
            /**
             *
             * 请加入三方集成方的业务逻辑
@@ -100,7 +209,7 @@
    public void sendMassage() {
        try {
            PushClientImplPosition client = new PushClientImplPosition();
            client.setLog(true);//是否打印明文
            client.setLog(false);//是否打印明文
            client.setHost(this.ip);//服务器IP
            client.setPort(10100);//服务器端口
            client.setUserName(this.userId);//系统用户名
@@ -120,4 +229,133 @@
    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;
    }*/
}