package com.zy.asrs.service.impl;
|
|
import com.alibaba.fastjson.JSON;
|
import com.alibaba.fastjson.JSONObject;
|
import com.core.common.Cools;
|
import com.core.exception.CoolException;
|
import com.zy.asrs.entity.*;
|
import com.zy.asrs.mapper.*;
|
import com.zy.asrs.service.*;
|
import com.zy.asrs.utils.Utils;
|
import com.zy.common.model.*;
|
import com.zy.common.model.enums.NavigationMapType;
|
import com.zy.common.service.CommonService;
|
import com.zy.common.service.erp.ErpService;
|
import com.zy.common.utils.*;
|
import com.zy.core.DevpThread;
|
import com.zy.core.News;
|
import com.zy.core.cache.MessageQueue;
|
import com.zy.core.cache.SlaveConnection;
|
import com.zy.core.enums.*;
|
import com.zy.core.model.*;
|
import com.zy.core.model.command.*;
|
import com.zy.core.model.protocol.*;
|
import com.zy.core.properties.SlaveProperties;
|
import com.zy.core.thread.*;
|
import lombok.extern.slf4j.Slf4j;
|
import org.springframework.beans.factory.annotation.Autowired;
|
import org.springframework.beans.factory.annotation.Value;
|
import org.springframework.stereotype.Service;
|
import org.springframework.transaction.annotation.Transactional;
|
import org.springframework.transaction.interceptor.TransactionAspectSupport;
|
|
import java.util.*;
|
import java.util.stream.Collectors;
|
|
/**
|
* 立体仓库WCS系统主流程业务
|
* Created by vincent on 2020/8/6
|
*/
|
@Slf4j
|
@Service("mainService")
|
@Transactional
|
public class MainServiceImpl {
|
|
@Value("${wms.url}")
|
private String wmsUrl;
|
@Autowired
|
private SlaveProperties slaveProperties;
|
@Autowired
|
private WrkMastMapper wrkMastMapper;
|
@Autowired
|
private WrkMastService wrkMastService;
|
@Autowired
|
private WrkDetlService wrkDetlService;
|
@Autowired
|
private LocMastService locMastService;
|
@Autowired
|
private LocDetlService locDetlService;
|
@Autowired
|
private StaDescService staDescService;
|
@Autowired
|
private BasDevpService basDevpService;
|
@Autowired
|
private BasErrLogService basErrLogService;
|
@Autowired
|
private BasSteErrLogService basSteErrLogService;
|
@Autowired
|
private BasShuttleService basShuttleService;
|
@Autowired
|
private BasShuttleErrLogService basShuttleErrLogService;
|
@Autowired
|
private BasShuttleErrService basShuttleErrService;
|
@Autowired
|
private BasCrnErrorMapper basCrnErrorMapper;
|
@Autowired
|
private BasSteService basSteService;
|
@Autowired
|
private WrkChargeService wrkChargeService;
|
@Autowired
|
private BasSteErrService basSteErrService;
|
@Autowired
|
private CommonService commonService;
|
@Autowired
|
private WrkChargeMapper wrkChargeMapper;
|
@Autowired
|
private BasMapService basMapService;
|
@Autowired
|
private ErpService erpService;
|
@Autowired
|
private OrderMapper orderMapper;
|
@Autowired
|
private OrderDetlMapper orderDetlMapper;
|
@Autowired
|
private BasLiftService basLiftService;
|
@Autowired
|
private ShuttleDispatchUtils shuttleDispatchUtils;
|
@Autowired
|
private RedisUtil redisUtil;
|
|
/**
|
* 组托
|
* 入库站，根据条码扫描生成入库工作档，工作状态 2
|
*/
|
public void generateStoreWrkFile() {
|
// 根据输送线plc遍历
|
for (DevpSlave devp : slaveProperties.getDevp()) {
|
// 遍历入库口
|
for (DevpSlave.Sta inSta : devp.getInSta()) {
|
// 获取入库站信息
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
|
StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
|
if (staProtocol == null) {
|
continue;
|
} else {
|
staProtocol = staProtocol.clone();
|
}
|
Short workNo = staProtocol.getWorkNo();
|
// 尺寸检测异常
|
boolean back = false;
|
String errMsg = "异常：";
|
if (staProtocol.isFrontErr()) {
|
errMsg = errMsg+"前超限；";
|
back = true;
|
}
|
if (staProtocol.isBackErr()) {
|
errMsg = errMsg+"后超限";
|
back = true;
|
}
|
if (staProtocol.isHighErr()) {
|
errMsg = errMsg+"高超限";
|
back = true;
|
}
|
if (staProtocol.isLeftErr()) {
|
errMsg = errMsg+"左超限";
|
back = true;
|
}
|
if (staProtocol.isRightErr()) {
|
errMsg = errMsg+"右超限";
|
back = true;
|
}
|
if (staProtocol.isWeightErr()) {
|
errMsg = errMsg+"超重";
|
back = true;
|
}
|
if (staProtocol.isBarcodeErr()) {
|
errMsg = errMsg+"扫码失败";
|
back = true;
|
}
|
// 退回
|
if (back) {
|
// led 异常显示
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
|
if (ledThread != null) {
|
MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));
|
}
|
continue;
|
}
|
|
// 判断是否满足入库条件
|
if (staProtocol.isAutoing() && staProtocol.isLoading()
|
&& staProtocol.isInEnable()
|
&& !staProtocol.isEmptyMk() && (workNo == 0 || (workNo >= 9990 && workNo <= 9999))
|
) {
|
|
// 获取条码扫描仪信息
|
BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, inSta.getBarcode());
|
if (barcodeThread == null) {
|
continue;
|
}
|
String barcode = barcodeThread.getBarcode();
|
if(!Cools.isEmpty(barcode)) {
|
// News.info("{}号条码扫描器检测条码信息：{}", inSta.getBarcode(), barcode);
|
if("NG".endsWith(barcode) || "NoRead".equals(barcode) || "empty".equals(barcode)|| "00000000".equals(barcode)) {
|
// staProtocol.setWorkNo((short) 32002);
|
// staProtocol.setStaNo(inSta.getBackSta().shortValue());
|
// devpThread.setPakMk(staProtocol.getSiteId(), false);
|
// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
|
// led 异常显示
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
|
if (ledThread != null) {
|
String errorMsg = "扫码失败，请重试";
|
MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
|
}
|
continue;
|
}
|
} else {
|
// staProtocol.setWorkNo((short) 32002);
|
// staProtocol.setStaNo(inSta.getBackSta().shortValue());
|
// devpThread.setPakMk(staProtocol.getSiteId(), false);
|
// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
|
// led 异常显示
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
|
if (ledThread != null) {
|
String errorMsg = "扫码失败，请重试";
|
MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
|
}
|
continue;
|
}
|
|
// 过滤盘点/拣料/并板任务
|
WrkMast wrkMast1 = wrkMastMapper.selectPickStepByBarcode(barcode);
|
if (null != wrkMast1) {
|
continue;
|
}
|
|
// 判断重复工作档
|
WrkMast wrkMast2 = wrkMastMapper.selectPakInStep1(inSta.getStaNo(), barcode);
|
if (wrkMast2 != null) {
|
News.error("工作档中已存在该站状态为（ 2.设备上走 ）的数据,工作号={}", wrkMast2.getWrkNo());
|
continue;
|
}
|
|
try {
|
LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
|
SearchLocParam param = new SearchLocParam();
|
param.setBarcode(barcode);
|
param.setIoType(1);
|
param.setSourceStaNo(inSta.getStaNo());
|
// param.setLocType1(locTypeDto.getLocType1());
|
String response = new HttpHandler.Builder()
|
.setUri(wmsUrl)
|
.setPath("/rpc/pakin/loc/v1")
|
.setJson(JSON.toJSONString(param))
|
.build()
|
.doPost();
|
JSONObject jsonObject = JSON.parseObject(response);
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
|
Integer code = jsonObject.getInteger("code");
|
if (code.equals(200)) {
|
StartupDto dto = jsonObject.getObject("data", StartupDto.class);
|
// plc 处理
|
barcodeThread.setBarcode("");
|
staProtocol.setWorkNo(dto.getWorkNo().shortValue());
|
staProtocol.setStaNo(dto.getStaNo().shortValue());
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
|
boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
if (!result) {
|
throw new CoolException("更新plc站点信息失败");
|
}
|
|
// 判断重复工作档
|
WrkMast wrkMast = wrkMastMapper.selectPakInStep11(inSta.getStaNo());
|
if (wrkMast == null) { continue; }
|
|
// 更新工作主档
|
wrkMast.setWrkSts(2L); // 工作状态：2.设备上走
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) == 0) {
|
News.error("更新工作档失败！！！ [工作号：{}]", wrkMast.getWrkNo());
|
}
|
|
} else if (code == 500){
|
if (ledThread != null) {
|
String errorMsg = jsonObject.getString("msg");
|
if (!Cools.isEmpty(errorMsg)) {
|
MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
|
}
|
}
|
News.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
|
} else if (code == 700) {
|
staProtocol.setWorkNo((short) 32002);
|
staProtocol.setRollback102(1);//102站回退信号
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(5, staProtocol));
|
|
// led 异常显示
|
if (ledThread != null) {
|
String errorMsg = barcode + "托盘识别异常，请先进行组托！";
|
MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errorMsg));
|
}
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
|
}
|
}
|
}
|
}
|
}
|
|
/**
|
* wms入库
|
* 入库站，根据条码扫描生成入库工作档，工作状态 1 ==>> 2
|
*/
|
@Deprecated
|
public void generateStoreWrkFile0() {
|
// 根据输送线plc遍历
|
for (DevpSlave devp : slaveProperties.getDevp()) {
|
// 遍历入库口
|
for (DevpSlave.Sta inSta : devp.getInSta()) {
|
// 获取入库站信息
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
|
StaProtocol staProtocol = devpThread.getStation().get(inSta.getStaNo());
|
if (staProtocol == null) {
|
continue;
|
} else {
|
staProtocol = staProtocol.clone();
|
}
|
Short workNo = staProtocol.getWorkNo();
|
// 判断是否满足入库条件
|
if (staProtocol.isAutoing() && staProtocol.isLoading()
|
&& staProtocol.isInEnable()
|
&& !staProtocol.isEmptyMk() && (workNo == 0 || (workNo >= 9990 && workNo <= 9999))
|
&& staProtocol.isPakMk()) {
|
|
// 尺寸检测异常
|
boolean back = false;
|
String errMsg = "";
|
if (staProtocol.isFrontErr()) {
|
errMsg = "前超限";
|
back = true;
|
}
|
if (!back && staProtocol.isBackErr()) {
|
errMsg = "后超限";
|
back = true;
|
}
|
if (!back && staProtocol.isHighErr()) {
|
errMsg = "高超限";
|
back = true;
|
}
|
if (!back && staProtocol.isLeftErr()) {
|
errMsg = "左超限";
|
back = true;
|
}
|
if (!back && staProtocol.isRightErr()) {
|
errMsg = "右超限";
|
back = true;
|
}
|
if (!back && staProtocol.isWeightErr()) {
|
errMsg = "超重";
|
back = true;
|
}
|
if (!back && staProtocol.isBarcodeErr()) {
|
errMsg = "扫码失败";
|
back = true;
|
}
|
|
// 退回
|
if (back) {
|
News.warn("扫码入库失败，{}入库站因{}异常，托盘已被退回", inSta.getStaNo(), errMsg);
|
staProtocol.setWorkNo((short) 32002);
|
staProtocol.setStaNo(inSta.getBackSta().shortValue());
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
|
// led 异常显示
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, inSta.getLed());
|
if (ledThread != null) {
|
MessageQueue.offer(SlaveType.Led, inSta.getLed(), new Task(3, errMsg));
|
}
|
continue;
|
}
|
|
// 判断重复工作档
|
WrkMast wrkMast = wrkMastMapper.selectPakInStep11(inSta.getStaNo());
|
if (wrkMast == null) { continue; }
|
|
// 命令下发区 --------------------------------------------------------------------------
|
|
// 更新站点信息 且 下发plc命令
|
staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
|
staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
if (result) {
|
// 更新工作主档
|
wrkMast.setWrkSts(2L); // 工作状态：2.设备上走
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) == 0) {
|
News.error("更新工作档失败！！！ [工作号：{}]", wrkMast.getWrkNo());
|
}
|
} else {
|
News.error("发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
|
}
|
}
|
}
|
}
|
}
|
|
/**
|
* 拣料、并板、盘点再入库
|
*/
|
@Transactional
|
public synchronized void stnToCrnStnPick(){
|
for (DevpSlave devp : slaveProperties.getDevp()) {
|
// 遍历拣料入库口
|
for (DevpSlave.Sta pickSta : devp.getPickInSta()) {
|
|
// 获取拣料入库站信息
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
|
StaProtocol staProtocol = devpThread.getStation().get(pickSta.getStaNo());
|
if (staProtocol == null) {
|
continue;
|
} else {
|
staProtocol = staProtocol.clone();
|
}
|
if (staProtocol.isAutoing()
|
&& staProtocol.isLoading()
|
&& (staProtocol.getWorkNo() > 0 && staProtocol.getWorkNo() < 9999)
|
&& staProtocol.getStaNo().equals(staProtocol.getSiteId().shortValue())
|
&& staProtocol.isPakMk()){
|
|
// 获取条码扫描仪信息
|
BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, pickSta.getBarcode());
|
if (barcodeThread == null) {
|
continue;
|
}
|
String barcode = barcodeThread.getBarcode();
|
|
WrkMast wrkMast = null;
|
wrkMast = wrkMastMapper.selectPickStepByBarcode(barcode);
|
if (wrkMast == null) {
|
continue;
|
}
|
// if (staProtocol.getWorkNo() == 9996) {
|
// String barcode = barcodeThread.getBarcode();
|
// if(!Cools.isEmpty(barcode)) {
|
// News.info("{}号条码扫描器检测条码信息：{}", pickSta.getBarcode(), barcode);
|
// if("NG".endsWith(barcode) || "NoRead".equals(barcode) || "empty".equals(barcode)) {
|
// staProtocol.setWorkNo((short) 32002);
|
// staProtocol.setStaNo(pickSta.getBackSta().shortValue());
|
// devpThread.setPakMk(staProtocol.getSiteId(), false);
|
// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
//
|
// // led 异常显示
|
// LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
|
// if (ledThread != null) {
|
// String errorMsg = "扫码失败，请重试";
|
// MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
|
// }
|
// continue;
|
// }
|
// } else {
|
// staProtocol.setWorkNo((short) 32002);
|
// staProtocol.setStaNo(pickSta.getBackSta().shortValue());
|
// devpThread.setPakMk(staProtocol.getSiteId(), false);
|
// MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
//
|
// // led 异常显示
|
// LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
|
// if (ledThread != null) {
|
// String errorMsg = "扫码失败，请重试";
|
// MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
|
// }
|
// continue;
|
// }
|
// wrkMast = wrkMastMapper.selectPickStepByBarcode(barcode);
|
// if (null == wrkMast) {
|
// News.error("{}条码错误，暂无拣料任务！", barcode);
|
// }
|
// }
|
|
if ((wrkMast.getIoType() != 103 && wrkMast.getIoType() != 104 && wrkMast.getIoType() != 107)
|
|| Cools.isEmpty(wrkMast.getStaNo()) || Cools.isEmpty(wrkMast.getSourceStaNo()) ) {
|
continue;
|
}
|
|
try {
|
// 访问 WMS 获取入库库位
|
LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
|
SearchLocParam param = new SearchLocParam();
|
param.setWrkNo(wrkMast.getWrkNo());
|
param.setIoType(wrkMast.getIoType());
|
param.setSourceStaNo(pickSta.getStaNo());
|
// param.setLocType1(locTypeDto.getLocType1());
|
String response = new HttpHandler.Builder()
|
.setUri(wmsUrl)
|
.setPath("/rpc/pakin/loc/v1")
|
.setJson(JSON.toJSONString(param))
|
.build()
|
.doPost();
|
JSONObject jsonObject = JSON.parseObject(response);
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, pickSta.getLed());
|
Integer code = jsonObject.getInteger("code");
|
if (code.equals(200)) {
|
StartupDto dto = jsonObject.getObject("data", StartupDto.class);
|
|
// // 获取目标站
|
// Wrapper<StaDesc> wrapper = new EntityWrapper<StaDesc>()
|
// .eq("type_no", wrkMast.getIoType() - 50)
|
// .eq("stn_no", pickSta.getStaNo()) // 作业站点 = 拣料出库的目标站
|
// .eq("crn_no", dto.getCrnNo()); // 堆垛机号
|
// StaDesc staDesc = staDescService.selectOne(wrapper);
|
// if (Cools.isEmpty(staDesc)) {
|
// News.error("入库路径不存在！type_no={},stn_no={},crn_no={}", wrkMast.getIoType(), pickSta.getStaNo(), wrkMast.getCrnNo());
|
// continue;
|
// }
|
// // 堆垛机站点(目标站)
|
// Integer staNo = staDesc.getCrnStn();
|
|
// 保存工作明细档历史档
|
// if (wrkMastMapper.saveWrkDetlLog(wrkMast.getWrkNo()) == 0) {
|
// throw new CoolException("保存工作明细档历史档失败");
|
// }
|
// 保存工作主档历史档
|
if (wrkMastMapper.saveWrkMastLog(wrkMast.getWrkNo()) == 0) {
|
throw new CoolException(wrkMast.getWrkNo() + "保存工作主档历史档失败");
|
}
|
|
String sourceLocNo = wrkMast.getSourceLocNo().trim();
|
// 更新工作档数据状态
|
wrkMast.setIoType(wrkMast.getIoType() - 50); // 入出库类型: 103->53,104->54,107->57
|
wrkMast.setWrkSts(2L); // 工作状态: 2.设备上走
|
wrkMast.setSourceStaNo(pickSta.getStaNo()); // 源站
|
wrkMast.setStaNo(dto.getStaNo()); // 目标站
|
wrkMast.setCrnNo(dto.getCrnNo());
|
wrkMast.setLocNo(sourceLocNo); // 目标库位 = 出库时的源库位
|
wrkMast.setShuttleNo(null); // 穿梭车清空
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) == 0) {
|
throw new CoolException(wrkMast.getWrkNo() + "更新工作档数据状态失败");
|
}
|
if (wrkMastMapper.setSteEmpty(wrkMast.getWrkNo()) == 0) {
|
throw new CoolException(wrkMast.getWrkNo() + "更新工作档数据状态失败");
|
}
|
|
// 修改库位状态 Q.拣料/盘点/并板再入库
|
LocMast locMast = locMastService.selectById(sourceLocNo);
|
locMast.setLocSts("Q");
|
locMast.setModiTime(new Date());
|
if (!locMastService.updateById(locMast)) {
|
throw new CoolException("修改库位状态失败");
|
}
|
|
// 更新站点信息 且 下发plc命令
|
staProtocol.setWorkNo(wrkMast.getWrkNo().shortValue());
|
staProtocol.setStaNo(wrkMast.getStaNo().shortValue());
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
if (!result) {
|
News.error("发布命令至输送线队列失败！！！ [plc编号：{}]", devp.getId());
|
}
|
|
} else if (code == 500){
|
if (ledThread != null) {
|
String errorMsg = jsonObject.getString("msg");
|
if (!Cools.isEmpty(errorMsg)) {
|
MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
|
}
|
}
|
News.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
|
} else {
|
staProtocol.setWorkNo((short) 32002);
|
staProtocol.setStaNo(pickSta.getBackSta().shortValue());
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
|
// led 异常显示
|
if (ledThread != null) {
|
String errorMsg = jsonObject.getString("msg");
|
// String errorMsg = barcode + "托盘识别异常，请先进行组托！";
|
MessageQueue.offer(SlaveType.Led, pickSta.getLed(), new Task(3, errorMsg));
|
}
|
}
|
|
} catch (Exception e) {
|
e.printStackTrace();
|
TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
|
}
|
|
}
|
}
|
|
}
|
}
|
|
/**
|
* 初始化实时地图
|
*/
|
public synchronized void initRealtimeBasMap() {
|
for (int i = 1; i <= 10; i++) {//总共四层楼
|
Object data = redisUtil.get("realtimeBasMap_" + i);
|
if (data == null) {//redis地图数据为空，从数据库中获取
|
BasMap basMap = basMapService.selectLatestMap(i);
|
if (basMap == null) {
|
//数据库中也不存在地图数据，从地图文件中获取
|
//载入地图
|
NavigateMapData mapData = new NavigateMapData(i);
|
List<List<MapNode>> lists = mapData.getJsonData(-1, null, null);//获取完整地图(包括入库出库)
|
|
//存入数据库
|
basMap = new BasMap();
|
basMap.setData(JSON.toJSONString(lists));
|
basMap.setCreateTime(new Date());
|
basMap.setUpdateTime(new Date());
|
basMap.setLev(i);
|
|
if (!basMapService.insert(basMap)) {
|
log.info("地图数据存储失败");
|
}
|
}
|
|
//将数据库地图数据存入redis
|
redisUtil.set("realtimeBasMap_" + i, JSON.toJSONString(basMap));
|
}
|
}
|
}
|
|
/**
|
* 从redis中重启任务
|
*/
|
public synchronized void restartTaskFromRedis() {
|
HashMap<Object, Object> map = redisUtil.getRedis();
|
for (Object key : map.keySet()) {
|
if (key.toString().contains("lift_wrk_no_")) {//提升机任务
|
LiftRedisCommand redisCommand = JSON.parseObject(map.get(key).toString(), LiftRedisCommand.class);
|
if (redisCommand == null) {
|
continue;
|
}
|
|
Short liftNo = redisCommand.getLiftNo();
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftNo.intValue());
|
if (liftThread == null) {
|
continue;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
continue;
|
}
|
if (!liftProtocol.isIdle()) {
|
continue;
|
}
|
|
//提升机处于空闲状态，进行任务的恢复
|
liftProtocol.setTaskNo(redisCommand.getWrkNo());//将提升机线程分配任务号
|
liftProtocol.setProtocolStatus(LiftProtocolStatusType.WORKING);//工作状态
|
|
}else if(key.toString().contains("shuttle_wrk_no_")){//四向穿梭车任务
|
ShuttleRedisCommand redisCommand = JSON.parseObject(map.get(key).toString(), ShuttleRedisCommand.class);
|
if (redisCommand == null) {
|
continue;
|
}
|
|
Short shuttleNo = redisCommand.getShuttleNo();
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleNo.intValue());
|
if (shuttleThread == null) {
|
continue;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
if (!shuttleProtocol.isIdle()) {
|
continue;
|
}
|
|
//四向穿梭车处于空闲状态，进行任务的恢复
|
shuttleProtocol.setTaskNo(redisCommand.getWrkNo());//将四向穿梭车线程分配任务号
|
shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.WORKING);//工作状态
|
}
|
}
|
|
}
|
|
/**
|
* 入库 ===>> 四向穿梭车入库作业下发
|
*/
|
public synchronized void shuttleInExecute() {
|
// 根据输送线plc遍历
|
for (DevpSlave devp : slaveProperties.getDevp()) {
|
// 遍历入库站
|
for (DevpSlave.StaRack staRack : devp.getRackInStn()) {
|
// 获取入库站信息
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
|
StaProtocol staProtocol = devpThread.getStation().get(staRack.getStaNo());
|
if (staProtocol == null) {
|
continue;
|
} else {
|
staProtocol = staProtocol.clone();
|
}
|
Short workNo = staProtocol.getWorkNo();
|
BasDevp basDevp = basDevpService.selectById(staProtocol.getSiteId());
|
if (basDevp == null) {
|
continue;//站点信息不存在
|
}
|
|
// 判断是否满足入库条件，自动、有物、四向穿梭车可取信号
|
if (!(staProtocol.isAutoing() && staProtocol.isLoading() && staProtocol.isShuttleTakeEnable())) {
|
continue;
|
}
|
|
WrkMast wrkMast = wrkMastMapper.selectRackInStep4(workNo, staProtocol.getSiteId());
|
if (wrkMast == null) {
|
continue;
|
}
|
|
boolean step1 = this.shuttleInExecuteStep1(wrkMast, basDevp);//小车搬入库中
|
if (!step1) {
|
continue;
|
}
|
|
}
|
}
|
|
}
|
|
/**
|
* 入库-小车搬入库中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
public boolean shuttleInExecuteStep1(WrkMast wrkMast, BasDevp basDevp) {
|
if (wrkMast.getWrkSts() == 4) {
|
if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basDevp.getLocNo());//调度小车到货物所在输送站点进行取货
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
if (!shuttleProtocol.isIdle()) {
|
return false;
|
}
|
|
//判断小车是否到达输送站点库位
|
if (!shuttleProtocol.getCurrentLocNo().equals(basDevp.getLocNo())) {
|
//小车不在输送站点位置
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basDevp.getLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在输送站点进行取货
|
return false;
|
}
|
|
//小车已抵达输送站点位置，进行搬运货物
|
NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), basDevp.getLocNo(), wrkMast.getLocNo());
|
if (result == null) {//路径计算失败
|
return false;
|
}
|
|
//创建分配命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//入库模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
assignCommand.setCommands(result.getCommands());//运行命令
|
assignCommand.setNodes(result.getNodes());//路径节点
|
|
wrkMast.setWrkSts(5L);//4.提升机搬运完成 => 5.小车搬运中
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 出库 ===>> 四向穿梭车出库作业下发
|
*/
|
public synchronized void shuttleOutExecute() {
|
for (WrkMast wrkMast : wrkMastMapper.selectBy2125()) {
|
boolean step1 = this.shuttleOutExecuteStep1(wrkMast);//小车搬出库中
|
if (!step1) {
|
continue;
|
}
|
}
|
}
|
|
/**
|
* 出库-小车搬出库中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
public boolean shuttleOutExecuteStep1(WrkMast wrkMast) {
|
//21.生成出库任务 => 22.小车搬运中
|
if (wrkMast.getWrkSts() == 21) {
|
if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到货物所在库位进行取货
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
if (!shuttleProtocol.isIdle()) {
|
return false;
|
}
|
|
//获取目标站对应的输送站点
|
BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), wrkMast.getLiftNo());
|
if (targetBasDevp == null) {
|
return false;//缺少站点信息
|
}
|
|
//判断小车是否到达货物库位
|
if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) {
|
//小车不在输送站点位置
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在输送站点进行取货
|
return false;
|
}
|
|
//小车已抵达货物位置，进行搬运货物
|
NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), targetBasDevp.getLocNo());
|
if (result == null) {//出库路径计算失败
|
return false;
|
}
|
|
//创建分配命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.PAK_OUT.id.shortValue());//出库模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
assignCommand.setCommands(result.getCommands());//运行命令
|
assignCommand.setNodes(result.getNodes());//路径节点
|
|
wrkMast.setWrkSts(22L);//21.生成出库任务 => 22.小车搬运中
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 四向穿梭车任务完成
|
*/
|
public synchronized void shuttleFinished() {
|
for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
|
//获取四向穿梭车信息
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
//四向穿梭车状态为等待确认、小车处于空闲状态
|
if (shuttleProtocol.getProtocolStatus() == ShuttleProtocolStatusType.WAITING.id //任务完成等待确认
|
&& shuttleProtocol.getTaskNo() != 0
|
&& shuttleProtocol.getFree() == ShuttleStatusType.IDLE.id
|
) {
|
//将任务档标记为完成
|
WrkMast wrkMast = wrkMastMapper.selectByWorkNo(shuttleProtocol.getTaskNo().intValue());
|
if (wrkMast != null) {
|
switch (wrkMast.getWrkSts().intValue()) {
|
case 5://5.小车搬运中 ==> 9.入库完成
|
wrkMast.setWrkSts(9L);
|
//任务号清零
|
shuttleProtocol.setTaskNo(0);
|
break;
|
case 22://22.小车搬运中 ==> 23.小车搬运完成
|
wrkMast.setWrkSts(23L);
|
break;
|
case 102://102.小车到提升机中 ==> 103.小车到提升机完成
|
wrkMast.setWrkSts(103L);
|
break;
|
case 106://106.小车迁出提升机中 ==> 107.小车迁出提升机完成
|
wrkMast.setWrkSts(107L);
|
break;
|
case 108://108.小车移动中 ==> 109.小车移动完成
|
wrkMast.setWrkSts(109L);
|
break;
|
default:
|
}
|
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//设置四向穿梭车为空闲状态
|
shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.IDLE);
|
//源库位清零
|
shuttleProtocol.setSourceLocNo(null);
|
//目标库位清零
|
shuttleProtocol.setLocNo(null);
|
//任务指令清零
|
shuttleProtocol.setAssignCommand(null);
|
News.info("四向穿梭车已确认且任务完成状态,复位。四向穿梭车号={}", shuttleProtocol.getShuttleNo());
|
} else {
|
News.error("四向穿梭车已确认且任务完成状态,复位失败，但未找到工作档。四向穿梭车号={}，工作号={}", shuttleProtocol.getShuttleNo(), shuttleProtocol.getTaskNo());
|
}
|
}
|
|
}
|
|
}
|
}
|
|
/**
|
* 提升机任务
|
*/
|
public synchronized void liftIoExecute() {
|
for (LiftSlave liftSlave : slaveProperties.getLift()) {
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
|
if (liftThread == null) {
|
continue;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
continue;
|
}
|
|
if (!liftProtocol.isIdle()) {
|
continue;
|
}
|
|
//搜索是否有待处理的任务
|
List<WrkMast> wrkMasts = wrkMastMapper.selectLiftStep223103();
|
if (wrkMasts.isEmpty()) {
|
continue;
|
}
|
|
for (WrkMast wrkMast : wrkMasts) {
|
//搜索是否有其他任务占用了提升机，如果占用提升机的任务和当前任务相同，则运行执行
|
WrkMast wrkMast1 = wrkMastMapper.selectLiftWrkMast(liftProtocol.getLiftNo().intValue());
|
if (wrkMast1 != null && wrkMast1.getWrkNo().intValue() != wrkMast.getWrkNo().intValue()) {
|
continue;
|
}
|
|
boolean stepIn = this.liftIoExecuteStepIn(wrkMast);//提升机入库
|
if (!stepIn) {
|
continue;
|
}
|
|
boolean stepOut = this.liftIoExecuteStepOut(wrkMast);//提升机出库
|
if (!stepOut) {
|
continue;
|
}
|
}
|
|
}
|
}
|
|
/**
|
* 提升机入库
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean liftIoExecuteStepIn(WrkMast wrkMast) {
|
//--------------------------------------提升机入库-----------------------------------------//
|
Date now = new Date();
|
|
//2.设备上走 ==> 3.提升机搬运中
|
if (wrkMast.getWrkSts() == 2) {
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
|
if (liftThread == null) {
|
return false;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
return false;
|
}
|
if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
|
return false;
|
}
|
//判断提升机是否有其他任务
|
WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId());
|
if (liftWrkMast != null) {
|
return false;//当前提升机存在未完成任务，等待下一次轮询
|
}
|
|
//获取源站对应的输送站点
|
BasDevp sourceBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo());
|
//获取目标站对应的输送站点
|
BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getStaNo());
|
if (sourceBasDevp == null || targetBasDevp == null) {
|
return false;//缺少站点信息
|
}
|
|
//获取提升机命令
|
NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo());
|
|
ArrayList<NyLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
LiftAssignCommand assignCommand = new LiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(liftProtocol.getLiftNo());
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
|
assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue());
|
|
wrkMast.setWrkSts(3L);//2.设备上走 ==> 3.提升机搬运中
|
wrkMast.setLiftNo(liftThread.getSlave().getId());//任务档绑定提升机号
|
wrkMast.setModiTime(now);
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
|
}
|
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 提升机出库
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean liftIoExecuteStepOut(WrkMast wrkMast) {
|
//--------------------------------------提升机出库-----------------------------------------//
|
Date now = new Date();
|
|
//23.小车搬运完成 ==> 24.提升机搬运中
|
if (wrkMast.getWrkSts() == 23) {
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
|
if (liftThread == null) {
|
return false;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
return false;
|
}
|
if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
|
return false;
|
}
|
//判断提升机是否有其他任务
|
WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(liftThread.getSlave().getId());
|
if (liftWrkMast != null) {
|
return false;//当前提升机存在未完成任务，等待下一次轮询
|
}
|
|
//获取源站对应的输送站点
|
BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue());
|
//获取目标站对应的输送站点
|
BasDevp targetBasDevp = basDevpService.selectById(wrkMast.getSourceStaNo());
|
if (sourceBasDevp == null || targetBasDevp == null) {
|
return false;//缺少站点信息
|
}
|
|
//获取提升机命令
|
NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_TRAY.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo());
|
|
ArrayList<NyLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
LiftAssignCommand assignCommand = new LiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(liftProtocol.getLiftNo());
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
|
assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_TRAY.id.shortValue());
|
|
wrkMast.setWrkSts(24L);//23.小车搬运完成 ==> 24.提升机搬运中
|
wrkMast.setLiftNo(liftThread.getSlave().getId());//任务档绑定提升机号
|
wrkMast.setModiTime(now);
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
|
}
|
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 提升机任务完成
|
*/
|
public synchronized void liftFinished() {
|
for (LiftSlave liftSlave : slaveProperties.getLift()) {
|
//获取提升机信息
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, liftSlave.getId());
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
continue;
|
}
|
|
//提升机为等待确认且空闲
|
if (liftProtocol.getProtocolStatus() == LiftProtocolStatusType.WAITING.id
|
&& liftProtocol.getTaskNo() != 0
|
&& !liftProtocol.getBusy()
|
) {
|
|
//将任务档标记为完成
|
WrkMast wrkMast = wrkMastMapper.selectByWorkNo324104(liftProtocol.getTaskNo().intValue());
|
if (wrkMast != null) {
|
switch (wrkMast.getWrkSts().intValue()) {
|
case 3://3.提升机搬运中 ==> 4.提升机搬运完成
|
wrkMast.setWrkSts(4L);
|
wrkMast.setLiftNo(null);//释放提升机
|
break;
|
case 24://24.提升机搬运中 ==> 25.提升机搬运完成
|
wrkMast.setWrkSts(25L);
|
break;
|
case 104://104.提升机搬运中 ==> 105.提升机搬运完成
|
wrkMast.setWrkSts(105L);
|
break;
|
default:
|
}
|
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//设置提升机为空闲状态
|
liftProtocol.setProtocolStatus(LiftProtocolStatusType.IDLE);
|
//任务指令清零
|
liftProtocol.setAssignCommand(null);
|
News.info("提升机已确认且任务完成状态。提升机号={}", liftProtocol.getLiftNo());
|
} else {
|
News.error("提升机已确认且任务完成状态,复位失败，但未找到工作档。提升机号={}，工作号={}", liftProtocol.getLiftNo(), liftProtocol.getTaskNo());
|
}
|
}
|
|
}
|
}
|
}
|
|
/**
|
* 库位移转
|
*/
|
public synchronized void locToLocExecute() {
|
//获取出入库工作档
|
List<WrkMast> wrkMasts = wrkMastMapper.selectInOutWrkMast();
|
if (wrkMasts.size() > 0) {
|
//有出入库任务，必须等待任务执行完毕再执行库位移转
|
return;
|
}
|
|
//查询库位移转工作档
|
List<WrkMast> wrkMasts1 = wrkMastMapper.selectLocToLocWrkMast();
|
for (WrkMast wrkMast : wrkMasts1) {
|
boolean step1 = this.locToLocExecuteStep1(wrkMast);//库位移转
|
if (!step1) {
|
continue;
|
}
|
|
}
|
}
|
|
/**
|
* 库位移转
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean locToLocExecuteStep1(WrkMast wrkMast) {
|
if (wrkMast.getShuttleNo() == null) {
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到源库位进行取货
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
if (!shuttleProtocol.isIdle()) {
|
return false;
|
}
|
|
//判断小车是否到达源库位
|
if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) {
|
//小车不在源库位位置
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//调度小车到源库位进行取货
|
return false;
|
}
|
|
//小车已抵达源库位，进行搬运货物
|
NyShuttleOperaResult result = NyShuttleOperaUtils.getShuttleTransportCommands(wrkMast.getShuttleNo(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), wrkMast.getSourceLocNo(), wrkMast.getLocNo());
|
if (result == null) {//路径计算失败
|
return false;
|
}
|
|
//创建分配命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.PAK_IN.id.shortValue());//入库模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
assignCommand.setCommands(result.getCommands());//运行命令
|
assignCommand.setNodes(result.getNodes());//路径节点
|
|
wrkMast.setWrkSts(5L);//1.生成入库任务 => 5.小车搬运中
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
|
return true;
|
}
|
|
/**
|
* 异常信息记录
|
*/
|
public void recErr() {
|
try {
|
this.recShuttleErr();
|
} catch (Exception e) {
|
News.error("recErr fail", e);
|
}
|
}
|
|
/**
|
* 四向穿梭车异常信息记录
|
*/
|
private void recShuttleErr() {
|
Date now = new Date();
|
for (ShuttleSlave shuttleSlave : slaveProperties.getShuttle()) {
|
// 获取四向穿梭车信息
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttleSlave.getId());
|
if (shuttleThread == null) {
|
continue;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
if (shuttleProtocol.getTaskNo() != 0) {
|
//有任务
|
BasShuttleErrLog latest = basShuttleErrLogService.findLatestByTaskNo(shuttleSlave.getId(), shuttleProtocol.getTaskNo());
|
// 有异常
|
if (latest == null) {
|
if (shuttleProtocol.getErrState() != null && shuttleProtocol.getErrState() == 1) {
|
WrkMast wrkMast = wrkMastMapper.selectById(shuttleProtocol.getTaskNo());
|
if (wrkMast == null) {
|
continue;
|
}
|
BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getErrCode().get(0));
|
String errName = basShuttleErr==null? "未知异常":basShuttleErr.getErrName();
|
BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog(
|
null, // 编号
|
wrkMast.getWrkNo(), // 工作号
|
now, // 发生时间
|
null, // 结束时间
|
wrkMast.getWrkSts(), // 工作状态
|
wrkMast.getIoType(), // 入出库类型
|
shuttleSlave.getId(), // 四向穿梭车
|
null, // plc
|
wrkMast.getLocNo(), // 目标库位
|
wrkMast.getStaNo(), // 目标站
|
wrkMast.getSourceStaNo(), // 源站
|
wrkMast.getSourceLocNo(), // 源库位
|
wrkMast.getBarcode(), // 条码
|
shuttleProtocol.getErrCode().get(0), // 异常码
|
errName, // 异常
|
1, // 异常情况
|
now, // 添加时间
|
null, // 添加人员
|
now, // 修改时间
|
null, // 修改人员
|
"任务中异常" // 备注
|
);
|
if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
|
News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName);
|
}
|
}
|
} else {
|
// 异常修复
|
if (shuttleProtocol.getErrState() == null || shuttleProtocol.getErrState() == 0) {
|
latest.setEndTime(now);
|
latest.setUpdateTime(now);
|
latest.setStatus(2);
|
if (!basShuttleErrLogService.updateById(latest)) {
|
News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId());
|
}
|
}
|
}
|
}else {
|
// //无任务
|
// BasShuttleErrLog latest = basShuttleErrLogService.findLatest(shuttleSlave.getId());
|
// // 有异常
|
// if (shuttleProtocol.getStatusErrorCode() != null && shuttleProtocol.getStatusErrorCode() > 0) {
|
// // 记录新异常
|
// if (latest == null || (latest.getErrCode() != shuttleProtocol.getStatusErrorCode().intValue())) {
|
// BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(shuttleProtocol.getStatusErrorCode().intValue());
|
// String errName = basShuttleErr==null? "未知异常":basShuttleErr.getErrName();
|
// BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog(
|
// null, // 编号
|
// null, // 工作号
|
// now, // 发生时间
|
// null, // 结束时间
|
// null, // 工作状态
|
// null, // 入出库类型
|
// shuttleSlave.getId(), // 四向穿梭车
|
// null, // plc
|
// null, // 目标库位
|
// null, // 目标站
|
// null, // 源站
|
// null, // 源库位
|
// null, // 条码
|
// (int)shuttleProtocol.getStatusErrorCode(), // 异常码
|
// errName, // 异常
|
// 1, // 异常情况
|
// now, // 添加时间
|
// null, // 添加人员
|
// now, // 修改时间
|
// null, // 修改人员
|
// "无任务异常" // 备注
|
// );
|
// if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
|
// News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", shuttleSlave.getId(), errName);
|
// }
|
// }
|
// // 无异常
|
// } else {
|
// // 异常修复
|
// if (latest != null && latest.getStatus() == 1) {
|
// latest.setEndTime(now);
|
// latest.setUpdateTime(now);
|
// latest.setStatus(2);
|
// if (!basShuttleErrLogService.updateById(latest)) {
|
// News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", shuttleSlave.getId(), latest.getId());
|
// }
|
// }
|
// }
|
}
|
}
|
}
|
|
// -------------------------------------------------------------------------------
|
|
/**
|
* 空栈板初始化入库,叉车入库站放货
|
*/
|
public void storeEmptyPlt(){
|
for (DevpSlave devp : slaveProperties.getDevp()) {
|
// 遍历空板入库口
|
for (DevpSlave.Sta emptyInSta : devp.getEmptyInSta()) {
|
// 获取空板入库站信息
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, devp.getId());
|
StaProtocol staProtocol = devpThread.getStation().get(emptyInSta.getStaNo());
|
if (staProtocol == null) {
|
continue;
|
} else {
|
staProtocol = staProtocol.clone();
|
}
|
// 站点条件判断
|
if (staProtocol.isAutoing()
|
&& staProtocol.isLoading()
|
&& staProtocol.isInEnable()
|
&& staProtocol.isEmptyMk()
|
&& (staProtocol.getWorkNo() == 0 || (staProtocol.getWorkNo() >= 9990 || staProtocol.getWorkNo() <= 9999))
|
&& staProtocol.isPakMk()) {
|
|
// 获取条码扫描仪信息
|
String barcode = null;
|
BarcodeThread barcodeThread = (BarcodeThread) SlaveConnection.get(SlaveType.Barcode, emptyInSta.getBarcode());
|
if (barcodeThread != null) {
|
String barcode0 = barcodeThread.getBarcode();
|
if(!Cools.isEmpty(barcode0)) {
|
// News.info("{}号条码扫描器检测条码信息：{}", emptyInSta.getBarcode(), barcode0);
|
if(!"NG".endsWith(barcode0) && !"NoRead".equals(barcode0) && !"empty".equals(barcode0)) {
|
barcode = barcode0;
|
}
|
}
|
}
|
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, emptyInSta.getLed());
|
|
try {
|
LocTypeDto locTypeDto = new LocTypeDto(staProtocol);
|
|
SearchLocParam param = new SearchLocParam();
|
param.setIoType(10);
|
if (!Cools.isEmpty(barcode)) {
|
param.setBarcode(barcode);
|
}
|
param.setSourceStaNo(emptyInSta.getStaNo());
|
// param.setLocType1(locTypeDto.getLocType1());
|
String response = new HttpHandler.Builder()
|
.setUri(wmsUrl)
|
.setPath("/rpc/pakin/loc/v1")
|
.setJson(JSON.toJSONString(param))
|
.build()
|
.doPost();
|
JSONObject jsonObject = JSON.parseObject(response);
|
Integer code = jsonObject.getInteger("code");
|
if (code.equals(200)) {
|
StartupDto dto = jsonObject.getObject("data", StartupDto.class);
|
|
// 更新站点信息 且 下发plc命令
|
staProtocol.setWorkNo(dto.getWorkNo().shortValue());
|
staProtocol.setStaNo(dto.getStaNo().shortValue());
|
devpThread.setPakMk(staProtocol.getSiteId(), false);
|
boolean result = MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(2, staProtocol));
|
if (!result) {
|
throw new CoolException("更新plc站点信息失败");
|
}
|
} else {
|
if (ledThread != null) {
|
String errorMsg = jsonObject.getString("msg");
|
if (!Cools.isEmpty(errorMsg)) {
|
MessageQueue.offer(SlaveType.Led, emptyInSta.getLed(), new Task(3, errorMsg));
|
}
|
}
|
News.error("请求接口失败！！！url：{}；request：{}；response：{}", wmsUrl + "/rpc/pakin/loc/v1", JSON.toJSONString(param), response);
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
|
}
|
|
}
|
|
|
}
|
}
|
}
|
|
/**
|
* 出库 ===>> 工作档信息写入led显示器
|
*/
|
public void ledExecute() {
|
for (LedSlave led : slaveProperties.getLed()) {
|
// 获取输送线plc线程
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
|
// 命令集合
|
List<LedCommand> commands = new ArrayList<>();
|
// 工作档集合
|
List<WrkMast> wrkMasts = new ArrayList<>();
|
for (Integer staNo : led.getStaArr()) {
|
// 获取叉车站点
|
StaProtocol staProtocol = devpThread.getStation().get(staNo);
|
if (null == staProtocol || null == staProtocol.getWorkNo() || 0 == staProtocol.getWorkNo() || !staProtocol.isLoading()) {
|
continue;
|
} else {
|
staProtocol = staProtocol.clone();
|
}
|
// 获取工作档数据
|
WrkMast wrkMast = wrkMastMapper.selectById(staProtocol.getWorkNo());
|
if (null == wrkMast || wrkMast.getWrkSts() < 14 || wrkMast.getIoType() < 100) { continue; }
|
wrkMasts.add(wrkMast);
|
// 组装命令
|
LedCommand ledCommand = new LedCommand();
|
ledCommand.setWorkNo(wrkMast.getWrkNo());
|
ledCommand.setIoType(wrkMast.getIoType());
|
// 出库模式
|
switch (wrkMast.getIoType()) {
|
case 101:
|
ledCommand.setTitle("全板出库");
|
break;
|
case 103:
|
ledCommand.setTitle("拣料出库");
|
break;
|
case 104:
|
ledCommand.setTitle("并板出库");
|
break;
|
case 107:
|
ledCommand.setTitle("盘点出库");
|
break;
|
case 110:
|
ledCommand.setTitle("空板出库");
|
ledCommand.setEmptyMk(true);
|
break;
|
default:
|
News.error("任务入出库类型错误！！！[工作号：{}] [入出库类型：{}]", wrkMast.getWrkNo(), wrkMast.getIoType());
|
break;
|
}
|
ledCommand.setSourceLocNo(wrkMast.getSourceLocNo());
|
ledCommand.setLocNo(wrkMast.getLocNo());
|
ledCommand.setStaNo(wrkMast.getStaNo());
|
if (wrkMast.getIoType() != 110 && wrkMast.getIoType() != 10) {
|
List<WrkDetl> wrkDetls = wrkDetlService.findByWorkNo(wrkMast.getWrkNo());
|
wrkDetls.forEach(wrkDetl -> ledCommand.getMatDtos().add(new MatDto(wrkDetl.getMatnr(), wrkDetl.getMaktx(), wrkDetl.getAnfme(),wrkDetl.getSpecs())));
|
}
|
commands.add(ledCommand);
|
}
|
Set<Integer> workNos = wrkMasts.stream().map(WrkMast::getWrkNo).collect(Collectors.toSet());
|
// 获取LED线程
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getId());
|
// 相同工作号集合则过滤
|
if (CollectionUtils.equals(ledThread.getWorkNos(), workNos)) {
|
continue;
|
}
|
// 命令下发 -------------------------------------------------------------------------------
|
if (!commands.isEmpty()) {
|
if (led.getId()>3){
|
if (!MessageQueue.offer(SlaveType.Led, led.getId()-3, new Task(1, commands))) {
|
log.error("{}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId()-3, led.getIp(), led.getPort());
|
continue;
|
}else {
|
ledThread.setLedMk(false);
|
}
|
}else {
|
if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(1, commands))) {
|
log.error("{}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
|
continue;
|
}else {
|
ledThread.setLedMk(false);
|
}
|
}
|
}
|
|
try {
|
// 修改主档led标记
|
for (WrkMast wrkMast : wrkMasts) {
|
wrkMast.setOveMk("Y");
|
wrkMast.setModiTime(new Date());
|
if (wrkMastMapper.updateById(wrkMast) == 0) {
|
throw new CoolException("更新工作档失败");
|
}
|
}
|
|
// 更新线程当前工作号集合
|
ledThread.setWorkNos(workNos);
|
|
} catch (Exception e) {
|
e.printStackTrace();
|
TransactionAspectSupport.currentTransactionStatus().setRollbackOnly();
|
}
|
|
}
|
}
|
|
/**
|
* 其他 ===>> LED显示器复位，显示默认信息
|
*/
|
public void ledReset() {
|
for (LedSlave led : slaveProperties.getLed()) {
|
|
// 获取输送线plc线程
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
|
// 命令集合
|
boolean reset = true;
|
for (Integer staNo : led.getStaArr()) {
|
// 获取叉车站点
|
StaProtocol staProtocol = devpThread.getStation().get(staNo);
|
if (staProtocol == null) {
|
continue;
|
}
|
if (staProtocol.getWorkNo() != 0 && staProtocol.isLoading()) {
|
reset = false;
|
break;
|
}
|
}
|
// 获取led线程
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getId());
|
// led显示默认内容
|
if (reset && !ledThread.isLedMk()) {
|
ledThread.setLedMk(true);
|
if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(4, new ArrayList<>()))) {
|
News.error(" - {}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
|
} else {
|
|
}
|
}
|
}
|
for (LedSlave led : slaveProperties.getLed()) {
|
// 获取输送线plc线程
|
DevpThread devpThread = (DevpThread) SlaveConnection.get(SlaveType.Devp, led.getDevpPlcId());
|
// 命令集合
|
boolean reset = true;
|
for (Integer staNo : led.getStaArr()) {
|
// 获取叉车站点
|
StaProtocol staProtocol = devpThread.getStation().get(staNo);
|
if (staProtocol == null) { continue; }
|
if (staProtocol.getWorkNo() != 0) {
|
reset = false;
|
break;
|
}
|
}
|
// 获取led线程
|
LedThread ledThread = (LedThread) SlaveConnection.get(SlaveType.Led, led.getId());
|
// led显示默认内容
|
if (reset && !ledThread.isLedMk()) {
|
ledThread.setLedMk(true);
|
if (!MessageQueue.offer(SlaveType.Led, led.getId(), new Task(2, new ArrayList<>()))) {
|
News.error("{}号LED命令下发失败！！！[ip：{}] [port：{}]", led.getId(), led.getIp(), led.getPort());
|
}
|
}
|
}
|
}
|
|
/**
|
* 四向穿梭车电量检测 ===>> 发起充电
|
*/
|
public synchronized void loopShuttleCharge() {
|
for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, shuttle.getId());
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
//判断当前小车是否满足需要充电要求
|
if (!shuttleProtocol.isRequireCharge()) {
|
continue;
|
}
|
|
WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttleProtocol.getShuttleNo().intValue());
|
if (wrkCharge != null) {//已有充电任务
|
continue;
|
}
|
|
ShuttleChargeType shuttleCharge = null;
|
for (ShuttleChargeType chargeType : ShuttleChargeType.values()) {
|
if (wrkChargeService.selectWorkingOfCharge(chargeType.id) == null) {
|
shuttleCharge = chargeType;
|
break;
|
}
|
}
|
|
if (shuttleCharge == null) {
|
continue;
|
}
|
|
String chargeLocNo = shuttleCharge.locNo;
|
wrkCharge = new WrkCharge();
|
wrkCharge.setShuttleNo(shuttle.getId());
|
wrkCharge.setCharge(shuttleCharge.id);
|
wrkCharge.setWrkNo(commonService.getChargeWorkNo(4));
|
wrkCharge.setWrkSts(51L); // 21.准备充电
|
wrkCharge.setIoPri((double) 10);
|
wrkCharge.setLocNo(chargeLocNo);
|
wrkCharge.setMemo("charge");
|
wrkCharge.setAppeTime(new Date());
|
if (!wrkChargeService.insert(wrkCharge)) {
|
News.error("保存{}号四向穿梭车充电任务失败!!!", shuttle.getId());
|
continue;
|
}
|
|
shuttleProtocol.setProtocolStatus(ShuttleProtocolStatusType.CHARGING);//充电中
|
News.info("保存{}号四向穿梭车充电任务成功!!!", shuttle.getId());
|
}
|
}
|
|
/**
|
* 执行四向穿梭车充电任务
|
*/
|
public synchronized void executeShuttleCharge() {
|
for (ShuttleSlave shuttle : slaveProperties.getShuttle()) {
|
WrkCharge wrkCharge = wrkChargeService.selectWorking(shuttle.getId());
|
if (wrkCharge == null) {
|
continue;
|
}
|
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkCharge.getShuttleNo());
|
if (shuttleThread == null) {
|
continue;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
if (wrkCharge.getWrkSts() == 51) {
|
if (!shuttleProtocol.getCurrentLocNo().equals(wrkCharge.getLocNo())) {
|
//小车不在充电桩位置
|
shuttleDispatchUtils.dispatchShuttle(wrkCharge.getWrkNo(), wrkCharge.getLocNo(), shuttle.getId());//调度小车去充电桩
|
continue;
|
}
|
|
//小车已经在充电桩位置，下发充电命令
|
NyShuttleHttpCommand chargeCommand = NyHttpUtils.getChargeCommand(shuttle.getId(), wrkCharge.getWrkNo(), true);
|
ArrayList<NyShuttleHttpCommand> commands = new ArrayList<>();
|
commands.add(chargeCommand);
|
//创建分配命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//出库模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
assignCommand.setCommands(commands);//运行命令
|
|
wrkCharge.setWrkSts(52L);//51.生成充电任务 => 52.小车去充电中
|
wrkCharge.setModiTime(new Date());
|
if (wrkChargeMapper.updateById(wrkCharge) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
} else if (wrkCharge.getWrkSts() == 52) {
|
//检测小车是否满电
|
if (shuttleProtocol.getPowerPercent() < 100) {
|
continue;
|
}
|
|
//小车满电，结束充电任务
|
NyShuttleHttpCommand chargeCommand = NyHttpUtils.getChargeCommand(shuttle.getId(), wrkCharge.getWrkNo(), false);
|
ArrayList<NyShuttleHttpCommand> commands = new ArrayList<>();
|
commands.add(chargeCommand);
|
//创建分配命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkCharge.getWrkNo().shortValue());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE.id.shortValue());//出库模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
assignCommand.setCommands(commands);//运行命令
|
|
wrkCharge.setWrkSts(53L);//52.小车去充电中 => 53.小车充电完成
|
wrkCharge.setModiTime(new Date());
|
if (wrkChargeMapper.updateById(wrkCharge) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
} else if (wrkCharge.getWrkSts() == 53) {
|
boolean result = Utils.searchEmptyGroupToMoveShuttle(Utils.getLev(wrkCharge.getLocNo()), shuttleThread.getSlave().getId(), shuttleThread);
|
if (!result) {
|
continue;
|
}
|
|
wrkCharge.setWrkSts(60L);//53.小车充电完成 => 60.充电任务完成
|
wrkCharge.setModiTime(new Date());
|
wrkChargeMapper.updateById(wrkCharge);
|
}
|
|
}
|
|
}
|
|
/**
|
* 执行小车移库任务
|
*/
|
public synchronized void shuttleMoveExecute() {
|
//查询小车移库任务
|
List<WrkMast> wrkMasts = wrkMastMapper.selectShuttleMoveWrk();
|
for (WrkMast wrkMast : wrkMasts) {
|
boolean step1 = this.shuttleMoveExecuteStep1(wrkMast);//小车移动到提升机中
|
if (!step1) {
|
continue;
|
}
|
|
boolean step2 = this.shuttleMoveExecuteStep2(wrkMast);//提升机搬运中
|
if (!step2) {
|
continue;
|
}
|
|
boolean step3 = this.shuttleMoveExecuteStep3(wrkMast);//小车迁出提升机中
|
if (!step3) {
|
continue;
|
}
|
|
boolean step4 = this.shuttleMoveExecuteStep4(wrkMast);//小车移动到目标库位中
|
if (!step4) {
|
continue;
|
}
|
}
|
}
|
|
/**
|
* 小车迁移-小车移动到提升机中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStep1(WrkMast wrkMast) {
|
//--------------------------------------小车移动到提升机中-----------------------------------------//
|
Date now = new Date();
|
|
//小车移动到提升机中 101.生成小车移库任务 ==> 102.小车到提升机中
|
if (wrkMast.getWrkSts() == 101) {
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleProtocol.isIdleNoCharge()) {
|
return false;
|
}
|
|
if (Utils.getLev(wrkMast.getLocNo()) == shuttleProtocol.getPoint().getZ()) {
|
//目标库位和小车库位处于同一楼层，需要通过提升机调度
|
return true;//直接进入108.小车移动中
|
}
|
|
//计算距离小车最近的提升机站点
|
//查询小车所在楼层提升机输送站点
|
int recentAllDistance = 9999999;//默认最近距离
|
BasDevp recentDevp = null;//最近站点
|
List<BasDevp> basDevps = basDevpService.selectHasLiftNoByLev(shuttleProtocol.getPoint().getZ());
|
for (BasDevp basDevp : basDevps) {
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, basDevp.getLiftNo());
|
if (liftThread == null) {
|
continue;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
continue;
|
}
|
if (!liftProtocol.isIdle()) {
|
continue;
|
}
|
|
//计算路径
|
List<NavigateNode> calc = NavigateUtils.calc(shuttleProtocol.getCurrentLocNo(), basDevp.getLocNo(), NavigationMapType.NORMAL.id, Utils.getShuttlePoints(shuttleThread.getSlave().getId(), Utils.getLev(shuttleProtocol.getCurrentLocNo())));
|
if (calc == null) {
|
continue;//计算失败，找下一个站点
|
}
|
|
Integer allDistance = NavigateUtils.getOriginPathAllDistance(calc);//根据原始节点结果，计算总行走距离
|
if (recentAllDistance > allDistance) {
|
recentAllDistance = allDistance;//更新距离
|
recentDevp = basDevp;//更新输送站点
|
}
|
}
|
|
if (recentDevp == null) {
|
//没有找到可用输送站点
|
return false;//等待下一次轮询
|
}
|
|
//获取提升机数据
|
BasLift basLift = basLiftService.selectById(recentDevp.getLiftNo());
|
if (basLift == null) {
|
return false;//没有提升机数据
|
}
|
if (basLift.getPoint() == null) {
|
return false;//没有设置提升机点位坐标
|
}
|
//判断提升机是否有其他任务
|
WrkMast liftWrkMast = wrkMastMapper.selectLiftWrkMast(basLift.getLiftNo());
|
if (liftWrkMast != null) {
|
return false;//当前提升机存在未完成任务，等待下一次轮询
|
}
|
NavigateNode liftNode = new NavigateNode(basLift.getPoint().getX(), basLift.getPoint().getY());
|
liftNode.setZ(basLift.getPoint().getZ());
|
|
//获取小车到输送站点行走命令
|
NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), shuttleProtocol.getCurrentLocNo(), recentDevp.getLocNo());
|
//获取小车进提升机行走命令
|
NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), NavigatePositionConvert.locNoToNode(recentDevp.getLocNo()), liftNode, true);
|
if (result.getCommands() == null) {
|
return false;//路径计算失败
|
}
|
List<NyShuttleHttpCommand> commands = result.getCommands();
|
commands.add(moveCommand);//添加小车迁入提升机命令
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
|
assignCommand.setAuto(true);//自动模式
|
assignCommand.setCommands(commands);
|
assignCommand.setNodes(result.getNodes());
|
|
wrkMast.setWrkSts(102L);//小车移动到提升机中 101.生成小车移库任务 ==> 102.小车到提升机中
|
wrkMast.setLiftNo(basLift.getLiftNo());//提升机号(锁定提升机防止被其他任务抢占)
|
wrkMast.setModiTime(now);
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-提升机搬运中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStep2(WrkMast wrkMast) {
|
//--------------------------------------提升机搬运中-----------------------------------------//
|
Date now = new Date();
|
|
//提升机搬运中 103.小车到提升机完成 ==> 104.提升机搬运中
|
if (wrkMast.getWrkSts() == 103) {
|
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
|
if (liftThread == null) {
|
return false;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
return false;
|
}
|
if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleProtocol.isIdleNoCharge()) {
|
return false;
|
}
|
|
//获取源站对应的输送站点
|
BasDevp sourceBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getSourceLocNo()), liftProtocol.getLiftNo().intValue());
|
//获取目标站对应的输送站点
|
BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue());
|
if (sourceBasDevp == null || targetBasDevp == null) {
|
return false;//缺少站点信息
|
}
|
|
//获取提升机命令
|
NyLiftCommand liftCommand = NyLiftUtils.getLiftCommand(liftProtocol.getLiftNo().intValue(), NyLiftTaskModelType.MOVE_CAR.id, sourceBasDevp.getDevNo(), targetBasDevp.getDevNo(), wrkMast.getWrkNo());
|
|
ArrayList<NyLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
LiftAssignCommand assignCommand = new LiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(liftProtocol.getLiftNo());
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());
|
assignCommand.setTaskMode(NyLiftTaskModelType.MOVE_CAR.id.shortValue());
|
|
wrkMast.setWrkSts(104L);//提升机搬运中 103.小车到提升机完成 ==> 104.提升机搬运中
|
wrkMast.setLiftNo(liftThread.getSlave().getId());//锁定提升机防止被占用
|
wrkMast.setModiTime(now);
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Lift, liftProtocol.getLiftNo().intValue(), new Task(3, assignCommand));
|
}
|
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-小车迁出提升机中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStep3(WrkMast wrkMast) {
|
//--------------------------------------小车迁出提升机中-----------------------------------------//
|
Date now = new Date();
|
|
//小车迁出提升机中 105.提升机搬运完成 ==> 106.小车迁出提升机中
|
if (wrkMast.getWrkSts() == 105) {
|
|
LiftThread liftThread = (LiftThread) SlaveConnection.get(SlaveType.Lift, wrkMast.getLiftNo());
|
if (liftThread == null) {
|
return false;
|
}
|
LiftProtocol liftProtocol = liftThread.getLiftProtocol();
|
if (liftProtocol == null) {
|
return false;
|
}
|
if (!liftProtocol.isIdle(wrkMast.getWrkNo().shortValue())) {
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleProtocol.isIdleNoCharge()) {
|
return false;
|
}
|
|
//获取目标站对应的输送站点
|
BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), liftProtocol.getLiftNo().intValue());
|
if (targetBasDevp == null) {
|
return false;//缺少站点信息
|
}
|
|
//获取提升机数据
|
BasLift basLift = basLiftService.selectById(targetBasDevp.getLiftNo());
|
if (basLift == null) {
|
return false;//没有提升机数据
|
}
|
if (basLift.getPoint() == null) {
|
return false;//没有设置提升机点位坐标
|
}
|
NavigateNode liftNode = new NavigateNode(basLift.getPoint().getX(), basLift.getPoint().getY());
|
liftNode.setZ(basLift.getPoint().getZ());
|
|
List<NyShuttleHttpCommand> commands = new ArrayList<>();
|
//获取小车出提升机行走命令
|
NyShuttleHttpCommand moveCommand = NyHttpUtils.getInOutLiftCommand(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), liftNode, NavigatePositionConvert.locNoToNode(targetBasDevp.getLocNo()), false);
|
commands.add(moveCommand);//添加小车迁出提升机命令
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
|
assignCommand.setAuto(true);//自动模式
|
assignCommand.setCommands(commands);
|
assignCommand.setNodes(null);
|
|
wrkMast.setWrkSts(106L);//小车迁出提升机中 105.提升机搬运完成 ==> 106.小车迁出提升机中
|
wrkMast.setModiTime(now);
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-小车移动到目标库位中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStep4(WrkMast wrkMast) {
|
//--------------------------------------小车移动到目标库位中-----------------------------------------//
|
Date now = new Date();
|
|
//小车移动到目标库位中 107.小车迁出提升机完成 ==> 108.小车移动中
|
if (wrkMast.getWrkSts() == 107) {
|
|
//获取四向穿梭车线程
|
NyShuttleThread shuttleThread = (NyShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
NyShuttleProtocol shuttleProtocol = shuttleThread.getShuttleProtocol();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleProtocol.isIdleNoCharge()) {
|
return false;
|
}
|
|
//获取目标站对应的输送站点
|
BasDevp targetBasDevp = basDevpService.selectByLevAndLiftNo(Utils.getLev(wrkMast.getLocNo()), wrkMast.getLiftNo());
|
if (targetBasDevp == null) {
|
return false;//缺少站点信息
|
}
|
|
//获取提升机数据
|
BasLift basLift = basLiftService.selectById(targetBasDevp.getLiftNo());
|
if (basLift == null) {
|
return false;//没有提升机数据
|
}
|
if (basLift.getPoint() == null) {
|
return false;//没有设置提升机点位坐标
|
}
|
NavigateNode liftNode = new NavigateNode(basLift.getPoint().getX(), basLift.getPoint().getY());
|
liftNode.setZ(basLift.getPoint().getZ());
|
|
//获取小车从输送站到目标库位命令
|
NyShuttleOperaResult result = NyShuttleOperaUtils.getStartToTargetCommands(shuttleThread.getSlave().getId(), wrkMast.getWrkNo(), targetBasDevp.getLocNo(), wrkMast.getLocNo());
|
if (result.getCommands() == null) {
|
return false;//路径计算失败
|
}
|
List<NyShuttleHttpCommand> commands = result.getCommands();
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.SHUTTLE_MOVE_LOC_NO.id.shortValue());//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo().shortValue());//任务号
|
assignCommand.setAuto(true);//自动模式
|
assignCommand.setCommands(commands);
|
assignCommand.setNodes(result.getNodes());
|
|
wrkMast.setWrkSts(108L);//小车移动到目标库位中 107.小车迁出提升机完成 ==> 108.小车移动中
|
wrkMast.setLiftNo(null);//释放提升机
|
wrkMast.setModiTime(now);
|
if (wrkMastMapper.updateById(wrkMast) > 0) {
|
//下发任务
|
MessageQueue.offer(SlaveType.Shuttle, assignCommand.getShuttleNo().intValue(), new Task(3, assignCommand));
|
}
|
}
|
return true;
|
}
|
|
/**
|
* 出入库模式切换
|
*/
|
public synchronized void outAndIn() {
|
try {
|
// 根据输送线plc遍历
|
for (DevpSlave devp : slaveProperties.getDevp()) {
|
for (DevpSlave.Sta inSta : devp.getInSta()) {
|
Thread.sleep(500);
|
boolean a=true,b=true;
|
List<WrkMast> wrkMasts = wrkMastMapper.selectAll(inSta.getStaNo());
|
if (Cools.isEmpty(wrkMasts)){
|
b=false;
|
}else {
|
for (WrkMast wrkMast:wrkMasts){
|
if (wrkMast.getSourceStaNo() > wrkMast.getStaNo()){
|
a=false;
|
break;
|
}
|
}
|
}
|
switch (inSta.getStaNo()) {
|
case 102://1F
|
if (a && b){
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 11));
|
}else if (b){
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 12));
|
}else {
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 10));
|
}
|
break;
|
case 202://2F
|
if (a && b){
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 21));
|
}else if (b){
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 22));
|
}else {
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 20));
|
}
|
break;
|
case 302://3F
|
if (a && b){
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 31));
|
}else if (b){
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 32));
|
}else {
|
MessageQueue.offer(SlaveType.Devp, devp.getId(), new Task(3, 30));
|
}
|
break;
|
}
|
}
|
}
|
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
|
}
|
