package com.zy.asrs.wcs.rcs.thread.impl; import com.alibaba.fastjson.JSON; import com.alibaba.fastjson.JSONObject; import com.baomidou.mybatisplus.core.conditions.query.LambdaQueryWrapper; import com.zy.asrs.common.utils.HttpHandler; import com.zy.asrs.framework.common.DateUtils; import com.zy.asrs.framework.common.SpringUtils; import com.zy.asrs.framework.exception.CoolException; import com.zy.asrs.wcs.core.entity.Loc; import com.zy.asrs.wcs.core.model.NavigateNode; import com.zy.asrs.wcs.core.model.command.ShuttleCommand; import com.zy.asrs.wcs.core.model.enums.ShuttleCommandModeType; import com.zy.asrs.wcs.core.model.enums.ShuttleRunDirection; import com.zy.asrs.wcs.core.service.LocService; import com.zy.asrs.wcs.core.utils.NavigateUtils; import com.zy.asrs.wcs.rcs.News; import com.zy.asrs.wcs.rcs.cache.OutputQueue; import com.zy.asrs.wcs.rcs.entity.DeviceDataLog; import com.zy.asrs.wcs.rcs.model.enums.ShuttleProtocolStatusType; import com.zy.asrs.wcs.rcs.model.enums.SlaveType; import com.zy.asrs.wcs.rcs.model.protocol.ShuttleProtocol; import com.zy.asrs.wcs.rcs.service.DeviceDataLogService; import com.zy.asrs.wcs.rcs.thread.ShuttleThread; import com.zy.asrs.wcs.core.utils.RedisUtil; import com.zy.asrs.wcs.rcs.entity.Device; import lombok.Data; import lombok.extern.slf4j.Slf4j; import java.text.MessageFormat; import java.text.SimpleDateFormat; import java.util.*; @Slf4j @SuppressWarnings("all") public class SurayShuttleThread implements ShuttleThread { private static final String API_URL = "http://127.0.0.1:8082"; private Device device; private RedisUtil redisUtil; private ShuttleProtocol shuttleProtocol; public SurayShuttleThread(Device device,RedisUtil redisUtil) { this.device = device; this.redisUtil = redisUtil; } @Override public void run() { News.info("{}号四向车线程启动", device.getDeviceNo()); this.connect(); while (true) { try { read(); Thread.sleep(500); } catch (Exception e) { log.error("ShuttleThread Fail", e); } } } private void read() { try { readStatus(); // //四向穿梭车空闲、有任务、标记为true、存在任务指令,需要执行任务的下一条指令 // if (shuttleProtocol.getTaskNo() != 0) { // Object obj = redisUtil.get(DeviceRedisConstant.SHUTTLE_WORK_FLAG + shuttleProtocol.getTaskNo()); // if (null != obj) { // ShuttleRedisCommand redisCommand = JSON.parseObject(obj.toString(), ShuttleRedisCommand.class); // executeWork(redisCommand); // } // } // // //小车空闲且有跑库程序 // if (shuttleProtocol.isIdle() && shuttleProtocol.getMoveLoc()) { // moveLoc(); // } } catch (Exception e) { log.error("ShuttleThread Fail!", e); OutputQueue.SHUTTLE.offer(MessageFormat.format("【{0}】读取四向穿梭车状态信息失败 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), device.getDeviceNo(), device.getIp(), device.getPort())); } } private void readStatus() { try { JSONObject data = requestDeviceStatus(); if (data != null) { if (null == shuttleProtocol) { shuttleProtocol = new ShuttleProtocol(); shuttleProtocol.setShuttleNo(Integer.valueOf(device.getDeviceNo())); shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE); shuttleProtocol.setDevice(device); InnerSuhttleExtend extend = new InnerSuhttleExtend(); shuttleProtocol.setExtend(extend); } //----------读取四向穿梭车状态----------- //小车设备状态 Integer deviceStatus = data.getInteger("deviceStatus"); shuttleProtocol.setDeviceStatus(deviceStatus); //当前二维码 shuttleProtocol.setCurrentCode(data.getString("groundCode") == null ? "0" : data.getString("groundCode")); //电池电量 shuttleProtocol.setBatteryPower(data.getString("battery") == null ? "0%" : data.getString("battery")); //是否顶升 shuttleProtocol.setHasLift(data.getInteger("palletStatus") == 1 ? true : false); //是否有托盘 shuttleProtocol.setHasPallet(data.getInteger("hasPallet") == null ? true : data.getInteger("hasPallet") != 2 ? true : false); //行驶方向 shuttleProtocol.setRunDirection(data.getString("direction") == null ? "none" : data.getString("direction")); //是否为充电状态 shuttleProtocol.setHasCharge((deviceStatus == 5 || deviceStatus == 13) ? true : false); //*********读取扩展字段********** InnerSuhttleExtend extend = (InnerSuhttleExtend) shuttleProtocol.getExtend(); extend.setMapVersion(data.getString("version"));//地图版本 extend.setStatusDescription(data.getString("statusDescription"));//状态描述 shuttleProtocol.setExtend(extend);//扩展字段 ///读取四向穿梭车状态-end //小车处于忙碌状态,将标记置为true if (!shuttleProtocol.getIdle()) { shuttleProtocol.setPakMk(true); } // if (shuttleProtocol.getProtocolStatusType() == null && shuttleProtocol.getDeviceStatus().intValue() == ShuttleDeviceStatusType.IDLE.id) { // //小车空闲状态、小车任务状态为未知,认定曾离线过,需要复位成空闲 // shuttleProtocol.setProtocolStatusType(ShuttleProtocolStatusType.IDLE); // } if (System.currentTimeMillis() - shuttleProtocol.getDeviceDataLog() > 1000 * 5) { //采集时间超过5s,保存一次数据记录 //保存数据记录 DeviceDataLogService deviceDataLogService = SpringUtils.getBean(DeviceDataLogService.class); DeviceDataLog deviceDataLog = new DeviceDataLog(); deviceDataLog.setOriginData(JSON.toJSONString(data)); deviceDataLog.setWcsData(JSON.toJSONString(shuttleProtocol)); deviceDataLog.setType(String.valueOf(SlaveType.Shuttle)); deviceDataLog.setDeviceNo(String.valueOf(shuttleProtocol.getShuttleNo())); deviceDataLog.setCreateTime(new Date()); deviceDataLog.setHostId(device.getHostId()); deviceDataLogService.save(deviceDataLog); //更新采集时间 shuttleProtocol.setDeviceDataLog(System.currentTimeMillis()); } } else { OutputQueue.SHUTTLE.offer(MessageFormat.format("【{0}】{1}读取四向穿梭车状态信息失败", DateUtils.convert(new Date()), device.getDeviceNo())); throw new CoolException(MessageFormat.format("读取四向穿梭车状态信息失败 ===>> [id:{0}] [ip:{1}] [port:{2}]", device.getDeviceNo(), device.getIp(), device.getPort())); } } catch (Exception e) { e.printStackTrace(); OutputQueue.SHUTTLE.offer(MessageFormat.format("【{0}】读取四向穿梭车状态信息失败 ===>> [id:{1}] [ip:{2}] [port:{3}]", DateUtils.convert(new Date()), device.getDeviceNo(), device.getIp(), device.getPort())); } } @Override public boolean connect() { return true; } @Override public void close() { } @Override public ShuttleProtocol getStatus() { return this.shuttleProtocol; } @Override public Device getDevice() { return this.device; } @Override public synchronized boolean movePath(List nodes, Integer taskNo) { try { String loginToken = requestLoginToken(); if (loginToken == null) { return false; } HashMap headers = new HashMap<>(); headers.put("Authorization", "Bearer " + loginToken); ArrayList> modes = new ArrayList<>(); //获取分段路径 ArrayList> data = NavigateUtils.getSectionPath(nodes); for (ArrayList sectionNodes : data) { boolean flag = true; int oper; //开始路径 NavigateNode startPath = nodes.get(0); if (ShuttleRunDirection.get(startPath.getDirection()) == ShuttleRunDirection.LEFT || ShuttleRunDirection.get(startPath.getDirection()) == ShuttleRunDirection.RIGHT) { //母轨方向 oper = 5; }else { //子轨方向 oper = 6; } for (NavigateNode node : sectionNodes) { HashMap map = new HashMap<>(); map.put("nodexX", node.getX()); map.put("nodexY", node.getY()); map.put("nodexZ", node.getZ()); if (flag) { map.put("oper", oper); flag = false; } modes.add(map); } } HashMap param = new HashMap<>(); param.put("messageName", "runRoute"); param.put("msgTime", new SimpleDateFormat("yyyy-MM-dd HH:mm:ss").format(new Date())); param.put("deviceNo", device.getDeviceNo()); param.put("taskId", taskNo); param.put("nodeNum", nodes.size()); param.put("modes", modes); String response = new HttpHandler.Builder() .setUri(API_URL) .setPath("/RDS/runRoute") .setHeaders(headers) .setJson(JSON.toJSONString(param)) .build() .doPost(); JSONObject jsonObject = JSON.parseObject(response); Integer code = jsonObject.getInteger("code"); if (code.equals(200)) { return true; } } catch (Exception e) { e.printStackTrace(); } return false; } @Override public synchronized boolean move(ShuttleCommand command) { try { String loginToken = requestLoginToken(); if (loginToken == null) { return false; } HashMap headers = new HashMap<>(); headers.put("Authorization", "Bearer " + loginToken); String response = new HttpHandler.Builder() .setUri(API_URL) .setPath("/RDS/runOrder") .setHeaders(headers) .setJson(command.getBody()) .build() .doPost(); JSONObject jsonObject = JSON.parseObject(response); Integer code = jsonObject.getInteger("code"); if (code.equals(200)) { return true; } } catch (Exception e) { e.printStackTrace(); } return false; } @Override public synchronized boolean lift(ShuttleCommand command) { try { String loginToken = requestLoginToken(); if (loginToken == null) { return false; } HashMap headers = new HashMap<>(); headers.put("Authorization", "Bearer " + loginToken); String response = new HttpHandler.Builder() .setUri(API_URL) .setPath("/RDS/actionOrder") .setHeaders(headers) .setJson(command.getBody()) .build() .doPost(); JSONObject jsonObject = JSON.parseObject(response); Integer code = jsonObject.getInteger("code"); if (code.equals(200)) { return true; } } catch (Exception e) { e.printStackTrace(); } return false; } @Override public synchronized boolean charge(ShuttleCommand command) { try { String loginToken = requestLoginToken(); if (loginToken == null) { return false; } HashMap headers = new HashMap<>(); headers.put("Authorization", "Bearer " + loginToken); String response = new HttpHandler.Builder() .setUri(API_URL) .setPath("/RDS/actionOrder") .setHeaders(headers) .setJson(command.getBody()) .build() .doPost(); JSONObject jsonObject = JSON.parseObject(response); Integer code = jsonObject.getInteger("code"); if (code.equals(200)) { return true; } } catch (Exception e) { e.printStackTrace(); } return false; } @Override public synchronized boolean reset(ShuttleCommand command) { return false; } @Override public boolean isIdle() { if (this.shuttleProtocol.getIdle() == null || this.shuttleProtocol.getPakMk() == null || this.shuttleProtocol.getErrorCode() == null || this.shuttleProtocol.getProtocolStatus() == null ) { return false; } boolean res = this.shuttleProtocol.getIdle() && this.shuttleProtocol.getPakMk() && this.shuttleProtocol.getErrorCode().equals("0") && this.shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.IDLE.id ; return res; } @Override public ShuttleCommand getMoveCommand(Integer taskNo, String startCodeNum, String distCodeNum, Integer allDistance, Integer runDirection, Integer runSpeed) { HashMap body = new HashMap<>(); body.put("messageName", "runOrder"); body.put("msgTime", new SimpleDateFormat("yyyy-MM-dd HH:mm:ss").format(new Date())); body.put("deviceNo", Integer.parseInt(this.device.getDeviceNo())); body.put("taskId", taskNo); LocService locService = SpringUtils.getBean(LocService.class); Loc loc = locService.getOne(new LambdaQueryWrapper() .eq(Loc::getCode, distCodeNum) .eq(Loc::getHostId, this.device.getHostId())); if (loc == null) { throw new CoolException("库位信息不存在"); } body.put("nodeX", loc.getRow()); body.put("nodeY", loc.getBay()); body.put("nodeZ", loc.getLev()); ShuttleCommand command = new ShuttleCommand(); command.setShuttleNo(Integer.parseInt(this.device.getDeviceNo())); command.setBody(JSON.toJSONString(body)); command.setMode(ShuttleCommandModeType.MOVE.id); command.setTargetLocNo(loc.getLocNo()); return command; } @Override public ShuttleCommand getLiftCommand(Integer taskNo, Boolean lift) { HashMap body = new HashMap<>(); body.put("messageName", "actionOrder"); body.put("msgTime", new SimpleDateFormat("yyyy-MM-dd HH:mm:ss").format(new Date())); body.put("deviceNo", Integer.parseInt(this.device.getDeviceNo())); body.put("taskId", taskNo); body.put("action", lift ? 1 : 2); ShuttleCommand command = new ShuttleCommand(); command.setShuttleNo(Integer.parseInt(this.device.getDeviceNo())); command.setBody(JSON.toJSONString(body)); command.setMode(lift ? ShuttleCommandModeType.PALLET_LIFT.id : ShuttleCommandModeType.PALLET_DOWN.id); return command; } @Override public ShuttleCommand getChargeCommand(Integer taskNo, Boolean charge) { HashMap body = new HashMap<>(); body.put("messageName", "runOrder"); body.put("msgTime", new SimpleDateFormat("yyyy-MM-dd HH:mm:ss").format(new Date())); body.put("deviceNo", Integer.parseInt(this.device.getDeviceNo())); body.put("taskId", taskNo); body.put("action", charge ? 3 : 4); ShuttleCommand command = new ShuttleCommand(); command.setShuttleNo(Integer.parseInt(this.device.getDeviceNo())); command.setBody(JSON.toJSONString(body)); command.setMode(charge ? ShuttleCommandModeType.CHARGE_OPEN.id : ShuttleCommandModeType.CHARGE_CLOSE.id); return command; } //***************设备层通讯-不同厂商设备通讯方案不一致*************** //请求登录 private String requestLoginToken() { try { HashMap param = new HashMap<>(); param.put("username", "admin"); param.put("password", "admin123"); param.put("msgTime", new SimpleDateFormat("yyyy-MM-dd HH:mm:ss").format(new Date())); String response = new HttpHandler.Builder() .setUri(API_URL) .setPath("/RDS/loginToken") .setJson(JSON.toJSONString(param)) .build() .doPost(); JSONObject jsonObject = JSON.parseObject(response); Integer code = jsonObject.getInteger("code"); if (code.equals(200)) { return jsonObject.getString("token"); } } catch (Exception e) { e.printStackTrace(); } return null; } //获取设备状态 private JSONObject requestDeviceStatus() { try { String loginToken = requestLoginToken(); if (loginToken == null) { return null; } HashMap headers = new HashMap<>(); headers.put("Authorization", "Bearer " + loginToken); HashMap param = new HashMap<>(); param.put("messageName", "deviceRgvStatus"); param.put("msgTime", new SimpleDateFormat("yyyy-MM-dd HH:mm:ss").format(new Date())); param.put("deviceNo", device.getDeviceNo()); String response = new HttpHandler.Builder() .setUri(API_URL) .setPath("/RDS/deviceRgvStatus") .setHeaders(headers) .setJson(JSON.toJSONString(param)) .build() .doPost(); JSONObject jsonObject = JSON.parseObject(response); Integer code = jsonObject.getInteger("code"); if (code.equals(200)) { return jsonObject.getJSONArray("data").getJSONObject(0); } } catch (Exception e) { e.printStackTrace(); } return null; } @Data private class InnerSuhttleExtend { /** * 地图版本 */ private String mapVersion; /** * 状态描述 */ private String statusDescription; } }