|  |  |  | 
|---|
|  |  |  | import HslCommunication.Profinet.Siemens.SiemensPLCS; | 
|---|
|  |  |  | import HslCommunication.Profinet.Siemens.SiemensS7Net; | 
|---|
|  |  |  | import com.alibaba.fastjson.JSON; | 
|---|
|  |  |  | import com.baomidou.mybatisplus.mapper.EntityWrapper; | 
|---|
|  |  |  | import com.core.common.Cools; | 
|---|
|  |  |  | import com.core.common.DateUtils; | 
|---|
|  |  |  | import com.core.common.SpringUtils; | 
|---|
|  |  |  | import com.core.exception.CoolException; | 
|---|
|  |  |  | import com.zy.asrs.entity.BasDevp; | 
|---|
|  |  |  | import com.zy.asrs.entity.BasRgv; | 
|---|
|  |  |  | import com.zy.asrs.entity.BasRgvMap; | 
|---|
|  |  |  | import com.zy.asrs.entity.BasRgvOpt; | 
|---|
|  |  |  | import com.zy.asrs.service.BasDevpService; | 
|---|
|  |  |  | import com.zy.asrs.service.BasRgvMapService; | 
|---|
|  |  |  | import com.zy.asrs.service.BasRgvOptService; | 
|---|
|  |  |  | import com.zy.asrs.service.BasRgvService; | 
|---|
|  |  |  | import com.zy.asrs.entity.*; | 
|---|
|  |  |  | import com.zy.asrs.service.*; | 
|---|
|  |  |  | import com.zy.common.utils.News; | 
|---|
|  |  |  | import com.zy.core.RgvThread2; | 
|---|
|  |  |  | import com.zy.core.ThreadHandler; | 
|---|
|  |  |  | 
|---|
|  |  |  | import lombok.Data; | 
|---|
|  |  |  | import lombok.extern.slf4j.Slf4j; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | import java.sql.Wrapper; | 
|---|
|  |  |  | import java.text.MessageFormat; | 
|---|
|  |  |  | import java.util.*; | 
|---|
|  |  |  | import java.util.concurrent.ConcurrentHashMap; | 
|---|
|  |  |  | 
|---|
|  |  |  | //锁定标记 | 
|---|
|  |  |  | private boolean PakMk = true; | 
|---|
|  |  |  | //入库标记 | 
|---|
|  |  |  | private boolean PakIn = true; | 
|---|
|  |  |  | //出库标记 | 
|---|
|  |  |  | private boolean PakOut = true; | 
|---|
|  |  |  | //根据距离跳过取货 | 
|---|
|  |  |  | private boolean PakRgv = true; | 
|---|
|  |  |  | //接驳标记 | 
|---|
|  |  |  | private boolean PakToCrn = true; | 
|---|
|  |  |  | //    private boolean PakIn = true; | 
|---|
|  |  |  | //    //出库标记 | 
|---|
|  |  |  | //    private boolean PakOut = true; | 
|---|
|  |  |  | //    //根据距离跳过取货 | 
|---|
|  |  |  | //    private boolean PakRgv  = true; | 
|---|
|  |  |  | //    //接驳标记 | 
|---|
|  |  |  | //    private boolean PakToCrn = true; | 
|---|
|  |  |  | // 任务锁定 | 
|---|
|  |  |  | private boolean Paking = true; | 
|---|
|  |  |  | private boolean Paking  = true; | 
|---|
|  |  |  | //    //连续任务下发 | 
|---|
|  |  |  | //    private boolean PakAll = true; | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public RgvThread(RgvSlave slave) { | 
|---|
|  |  |  | this.slave = slave; | 
|---|
|  |  |  | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | private static final Set<Integer> specialSites = new HashSet<>( | 
|---|
|  |  |  | Arrays.asList(1004,1014,1018,1028,1035)); | 
|---|
|  |  |  | Arrays.asList(1004,1014,1018,1028,1035,2006,2012,2018,2024,2030)); | 
|---|
|  |  |  | public static final Map<Integer, Integer> StaPosition = new HashMap<Integer, Integer>() {{ | 
|---|
|  |  |  | put(1004, 1001);put(1014, 1011);put(1018, 1015);put(1028, 1025);put(1035, 1032); | 
|---|
|  |  |  | put(2006, 2004);put(2012, 2010);put(2018, 2016);put(2024, 2022);put(2030, 2028); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | }}; | 
|---|
|  |  |  | public static final ArrayList<Integer> staNos1 = new ArrayList<Integer>() {{ | 
|---|
|  |  |  | 
|---|
|  |  |  | buffer[byteIndex] &= ~(1 << bitIndex); // 清零 | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | private void updateFlagInDb(String field, boolean value) { | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | BasRgvService basRgvService = SpringUtils.getBean(BasRgvService.class); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | EntityWrapper<BasRgv> wrapper = new EntityWrapper<>(); | 
|---|
|  |  |  | wrapper.eq("rgv_no", slave.getId()); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | BasRgv entity = new BasRgv(); | 
|---|
|  |  |  | switch (field) { | 
|---|
|  |  |  | case "pak_mk":    entity.setPakMk(value ? "1" : "0"); break; | 
|---|
|  |  |  | case "pak_in":    entity.setPakIn(value ? "1" : "0"); break; | 
|---|
|  |  |  | case "pak_out":   entity.setPakOut(value ? "1" : "0"); break; | 
|---|
|  |  |  | case "pak_rgv":   entity.setPakRgv(value ? "1" : "0"); break; | 
|---|
|  |  |  | case "pak_to_crn":entity.setPakToCrn(value ? "1" : "0"); break; | 
|---|
|  |  |  | case "paking":entity.setPaking(value ? "1" : "0"); break; | 
|---|
|  |  |  | case "pak_all":entity.setPakAll(value ? "1" : "0"); break; | 
|---|
|  |  |  | default: | 
|---|
|  |  |  | log.warn("未知标志位字段: {}", field); | 
|---|
|  |  |  | return; | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | basRgvService.update(entity, wrapper); | 
|---|
|  |  |  | //            log.info("RGV标志位更新成功 [rgv_no:{}] {}={}", slave.getId(), field, value ? "1" : "0"); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | } catch (Exception e) { | 
|---|
|  |  |  | log.error("更新RGV标志位异常 [rgv_no:{}] {}={} 错误:{}", slave.getId(), field, value, e.getMessage()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | public void setPakMk(boolean pakMk) { | 
|---|
|  |  |  | this.PakMk = pakMk; | 
|---|
|  |  |  | updateFlagInDb("pak_mk", pakMk); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  | /** | 
|---|
|  |  |  | * 读取状态 | 
|---|
|  |  |  | */ | 
|---|
|  |  |  | private void readStatus(){ | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | ArrayList<Integer> staNos = getStaNo(); | 
|---|
|  |  |  |  | 
|---|
|  |  |  | OperateResultExOne<byte[]> result = siemensNet.Read("DB101.0", (short) 38); | 
|---|
|  |  |  | OperateResultExOne<byte[]> result = siemensNet.Read("DB101.0", (short) 42); | 
|---|
|  |  |  | if (result.IsSuccess) { | 
|---|
|  |  |  | if (null == rgvProtocol) { | 
|---|
|  |  |  | rgvProtocol = new RgvProtocol(); | 
|---|
|  |  |  | 
|---|
|  |  |  | rgvProtocol.setErr10(status3[1]); | 
|---|
|  |  |  | rgvProtocol.setErr11(status3[2]); | 
|---|
|  |  |  | rgvProtocol.setErr12(status3[3]); | 
|---|
|  |  |  | BasRgvMapService basRgvMapService = SpringUtils.getBean(BasRgvMapService.class); | 
|---|
|  |  |  | boolean[] statusErr = siemensNet.getByteTransform().TransBool(result.Content, 36, 6); | 
|---|
|  |  |  | rgvProtocol.setEmergencyStop(statusErr[0]);       // 急停触发 | 
|---|
|  |  |  | rgvProtocol.setSlot1EmptyNoData(statusErr[1]);   // 1号位有物无资料 | 
|---|
|  |  |  | rgvProtocol.setSlot2EmptyNoData(statusErr[2]);   // 2号位有物无资料 | 
|---|
|  |  |  | rgvProtocol.setCommandErrorChainConflict(statusErr[3]); // 命令错误走链条冲突 | 
|---|
|  |  |  | rgvProtocol.setTargetPositionIssue(statusErr[4]); // 目标位下发错误 | 
|---|
|  |  |  | rgvProtocol.setTravelInverterError(statusErr[5]); // 走行变频器异常 | 
|---|
|  |  |  | rgvProtocol.setPhotoelectric1Error(statusErr[6]); // 1号光电异常 | 
|---|
|  |  |  | rgvProtocol.setPhotoelectric2Error(statusErr[7]); // 2号光电异常 | 
|---|
|  |  |  | rgvProtocol.setTimeoutConnectionWithLine(statusErr[8]); // 与输线时接超时 | 
|---|
|  |  |  | rgvProtocol.setLeftRollerTimeout(statusErr[9]);    // 左侧滚筒运行超时 | 
|---|
|  |  |  | rgvProtocol.setRightRollerTimeout(statusErr[10]);   // 右侧滚筒运行超时 | 
|---|
|  |  |  | rgvProtocol.setRgvRunTimeout(statusErr[11]);        // rgv运行超时 | 
|---|
|  |  |  | rgvProtocol.setPosition1ChainInverterError(statusErr[12]); // 1号工位链条变频器异常 | 
|---|
|  |  |  | rgvProtocol.setPosition2ChainInverterError(statusErr[13]); // 2号工位链条变频器异常 | 
|---|
|  |  |  | rgvProtocol.setFrontRearLimit(statusErr[14]);      // 前后极限位 | 
|---|
|  |  |  | rgvProtocol.setEmergencyButton(statusErr[15]);     // 急停按钮 | 
|---|
|  |  |  | rgvProtocol.setForwardButton(statusErr[16]);       // 前进按钮 | 
|---|
|  |  |  | rgvProtocol.setReverseButton(statusErr[17]);       // 后退按钮 | 
|---|
|  |  |  | rgvProtocol.setLocalRemote(statusErr[18]);         // 本地/远程 | 
|---|
|  |  |  | rgvProtocol.setReset(statusErr[19]);               // 复位 | 
|---|
|  |  |  | rgvProtocol.setTravelBrakeSwitch(statusErr[20]);   // 走行抱闸开关钮 | 
|---|
|  |  |  | rgvProtocol.setTravelSpeedLimitPhotoelectric(statusErr[21]); // 走行强制减速光电 | 
|---|
|  |  |  | rgvProtocol.setLeftOverlimit1(statusErr[22]);      // 左超限 1 | 
|---|
|  |  |  | rgvProtocol.setRightOverlimit1(statusErr[23]);     // 右超限 1 | 
|---|
|  |  |  | rgvProtocol.setLeftAtPosition1(statusErr[24]);     // 左到位 1 | 
|---|
|  |  |  | rgvProtocol.setRightAtPosition1(statusErr[25]);    // 右到位 1 | 
|---|
|  |  |  | rgvProtocol.setChainForward1(statusErr[26]);       // 链条前进 1 | 
|---|
|  |  |  | rgvProtocol.setChainReverse1(statusErr[27]);       // 链条后退 1 | 
|---|
|  |  |  | rgvProtocol.setInverterAlarm(statusErr[28]);       // 变频器报警 | 
|---|
|  |  |  | rgvProtocol.setLeftOverlimit2(statusErr[29]);      // 左超限 2 | 
|---|
|  |  |  | rgvProtocol.setRightOverlimit2(statusErr[30]);     // 右超限 2 | 
|---|
|  |  |  | rgvProtocol.setLeftAtPosition2(statusErr[31]);     // 左到位 2 | 
|---|
|  |  |  | rgvProtocol.setRightAtPosition2(statusErr[32]);    // 右到位 2 | 
|---|
|  |  |  | rgvProtocol.setCargoSpeedReduction(statusErr[33]); // 货物减速 | 
|---|
|  |  |  | rgvProtocol.setConveyorInverterAlarm2(statusErr[34]); // 输送变频器报警 2 | 
|---|
|  |  |  | rgvProtocol.setRightConveyor2(statusErr[35]);      // 右输送 2 | 
|---|
|  |  |  | rgvProtocol.setLeftConveyor2(statusErr[36]);       // 左输送 2 | 
|---|
|  |  |  | if(rgvProtocol.getStatus() == 99){ | 
|---|
|  |  |  | rgvProtocol.setErrorMk(true);//若存在异常触发写入 | 
|---|
|  |  |  | }else{ | 
|---|
|  |  |  | rgvProtocol.setWriteMk(true);//无异常后才能继续写入 | 
|---|
|  |  |  | rgvProtocol.setErrorMk(false); | 
|---|
|  |  |  | } | 
|---|
|  |  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  |  | 
|---|
|  |  |  | //                BasRgvMapService basRgvMapService = SpringUtils.getBean(BasRgvMapService.class); | 
|---|
|  |  |  | OutputQueue.RGV.offer(MessageFormat.format("【{0}】[id:{1}] <<<<< 实时数据更新成功", DateUtils.convert(new Date()), slave.getId())); | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | // 根据实时信息更新数据库 | 
|---|
|  |  |  | 
|---|
|  |  |  | BasRgv basRgv = new BasRgv(); | 
|---|
|  |  |  | basRgv.setRgvNo(slave.getId()); | 
|---|
|  |  |  | basRgv.setRgvSts((int)rgvProtocol.getMode()); | 
|---|
|  |  |  | if(rgvProtocol.isWriteMk() && rgvProtocol.isErrorMk()){ | 
|---|
|  |  |  | try { | 
|---|
|  |  |  | // 日志记录异常情况 | 
|---|
|  |  |  | BasRgvErrorLog basRgvErrorLogs; | 
|---|
|  |  |  | basRgvErrorLogs = rgvProtocol.toSqlModelError(); | 
|---|
|  |  |  | BasRgvErrorLogService basRgvErrorLogService = SpringUtils.getBean(BasRgvErrorLogService.class); | 
|---|
|  |  |  | basRgvErrorLogService.insert(basRgvErrorLogs); | 
|---|
|  |  |  | rgvProtocol.setWriteMk(false); | 
|---|
|  |  |  | } catch (Exception ignore) { | 
|---|
|  |  |  | log.error(ignore.getMessage()); | 
|---|
|  |  |  | } | 
|---|
|  |  |  | } | 
|---|
|  |  |  | if (!basRgvService.updateById(rgvProtocol.toSqlModel(basRgv))){ | 
|---|
|  |  |  | log.error("RGV plc数据库更新失败 ===>> [id:{}] [ip:{}] [port:{}] [rack:{}] [slot:{}]", slave.getId(), slave.getIp(), slave.getPort(), slave.getRack(), slave.getSlot()); | 
|---|
|  |  |  | } | 
|---|