package com.zy.asrs.service.impl;
|
|
import com.alibaba.fastjson.JSON;
|
import com.baomidou.mybatisplus.mapper.EntityWrapper;
|
import com.zy.asrs.domain.enums.NotifyMsgType;
|
import com.zy.asrs.entity.*;
|
import com.zy.asrs.service.*;
|
import com.zy.asrs.utils.NotifyUtils;
|
import com.zy.asrs.utils.Utils;
|
import com.zy.common.model.MapNode;
|
import com.zy.common.model.enums.NavigationMapType;
|
import com.zy.common.service.CommonService;
|
import com.zy.common.utils.*;
|
import com.zy.core.News;
|
import com.zy.core.action.ForkLiftAction;
|
import com.zy.core.action.ShuttleAction;
|
import com.zy.core.cache.SlaveConnection;
|
import com.zy.core.dispatcher.ForkLiftDispatchUtils;
|
import com.zy.core.dispatcher.ShuttleDispatchUtils;
|
import com.zy.core.enums.*;
|
import com.zy.core.model.command.*;
|
import com.zy.core.model.protocol.ForkLiftProtocol;
|
import com.zy.core.model.protocol.ForkLiftStaProtocol;
|
import com.zy.core.model.protocol.LiftStaProtocol;
|
import com.zy.core.model.protocol.ShuttleProtocol;
|
import com.zy.core.thread.ForkLiftThread;
|
import com.zy.core.thread.ShuttleThread;
|
import com.zy.system.entity.Config;
|
import com.zy.system.service.ConfigService;
|
import lombok.extern.slf4j.Slf4j;
|
import org.springframework.beans.factory.annotation.Autowired;
|
import org.springframework.stereotype.Service;
|
|
import java.util.ArrayList;
|
import java.util.Date;
|
import java.util.List;
|
|
/**
|
* 立体仓库WCS系统主流程业务
|
*/
|
@Slf4j
|
@Service("forkMainService")
|
public class ForkMainServiceImpl {
|
|
@Autowired
|
private WrkMastService wrkMastService;
|
@Autowired
|
private BasShuttleErrLogService basShuttleErrLogService;
|
@Autowired
|
private BasLiftErrLogService basLiftErrLogService;
|
@Autowired
|
private BasShuttleErrService basShuttleErrService;
|
@Autowired
|
private BasLiftErrService basLiftErrService;
|
@Autowired
|
private CommonService commonService;
|
@Autowired
|
private BasMapService basMapService;
|
@Autowired
|
private ShuttleDispatchUtils shuttleDispatchUtils;
|
@Autowired
|
private RedisUtil redisUtil;
|
@Autowired
|
private ConfigService configService;
|
@Autowired
|
private NavigateMapData navigateMapData;
|
@Autowired
|
private NavigateUtils navigateUtils;
|
@Autowired
|
private ShuttleOperaUtils shuttleOperaUtils;
|
@Autowired
|
private ShuttleAction shuttleAction;
|
@Autowired
|
private ForkLiftAction forkLiftAction;
|
@Autowired
|
private NotifyUtils notifyUtils;
|
@Autowired
|
private BasShuttleChargeService basShuttleChargeService;
|
@Autowired
|
private DeviceConfigService deviceConfigService;
|
@Autowired
|
private ForkLiftDispatchUtils forkLiftDispatchUtils;
|
|
/**
|
* 初始化实时地图
|
*/
|
public synchronized void initRealtimeBasMap() {
|
try {
|
|
List<BasMap> basMaps = basMapService.selectList(new EntityWrapper<BasMap>().orderBy("lev", true));
|
for (BasMap basMap : basMaps) {
|
Integer lev = basMap.getLev();
|
Object data = redisUtil.get(RedisKeyType.MAP.key + lev);
|
if (data == null) {//redis地图数据为空
|
//载入地图
|
List<List<MapNode>> lists = navigateMapData.getJsonOriginData(lev, NavigationMapType.getMapTypes(NavigationMapType.NONE), null, null);//获取完整地图(包括入库出库)
|
|
//存入数据库
|
basMap.setData(JSON.toJSONString(lists));
|
basMap.setCreateTime(new Date());
|
basMap.setUpdateTime(new Date());
|
if (!basMapService.updateById(basMap)) {
|
log.info("地图数据存储失败");
|
}
|
|
//将数据库地图数据存入redis
|
redisUtil.set(RedisKeyType.MAP.key + lev, JSON.toJSONString(basMap));
|
}
|
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 入库 ===>> 四向穿梭车入库作业下发
|
*/
|
public synchronized void shuttleInExecute() {
|
try {
|
List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.in("wrk_sts"
|
, WrkStsType.INBOUND_LIFT_RUN_COMPLETE.sts
|
)
|
.orderBy("io_pri", false)
|
.orderBy("appe_time", true)
|
);
|
for (WrkMast wrkMast : wrkMasts) {
|
boolean step1 = this.shuttleInExecuteStep1(wrkMast);//小车搬入库中
|
Thread.sleep(100);
|
if (!step1) {
|
continue;
|
}
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 入库-小车搬入库中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
public synchronized boolean shuttleInExecuteStep1(WrkMast wrkMast) {
|
if (wrkMast.getWrkSts() == WrkStsType.INBOUND_LIFT_RUN_COMPLETE.sts) {
|
//获取目标站
|
ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
|
if (liftSta == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，缺少站点信息，禁止派发", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
|
boolean result = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), liftSta.getLocNo());//调度小车到货物所在输送站点进行取货
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，调度小车{}系统等待中", wrkMast.getWrkNo(), result ? "成功" : "失败");
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
if (!shuttleThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车忙碌中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
//判断小车是否存在移动任务
|
WrkMast hasMoveWorking = wrkMastService.selectShuttleHasMoveWorking(wrkMast.getShuttleNo());
|
if (hasMoveWorking != null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}号小车，存在移动任务，禁止派发任务", wrkMast.getShuttleNo());
|
return false;//存在移动任务，禁止执行入库任务
|
}
|
|
//判断小车是否到达输送站点库位
|
if (!shuttleProtocol.getCurrentLocNo().equals(liftSta.getLocNo())) {
|
//小车不在输送站点位置
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), liftSta.getLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在输送站点进行取货
|
News.info("{}任务，{}小车，未到达输送站点，系统等待中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
//检测障碍物车
|
int checkObstacle = shuttleOperaUtils.checkObstacle(wrkMast.getLocNo(), new ArrayList<Integer>() {{
|
add(shuttleProtocol.getShuttleNo());
|
}}, new ArrayList<>());
|
if (checkObstacle > 0) {
|
News.info("{}任务，避障范围有小车，等待障碍小车调离中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.TRANSPORT.id);//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
|
//获取小车到输送站点行走命令
|
List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(liftSta.getLocNo(), wrkMast.getLocNo(), NavigationMapType.getDfxWithDevice(), assignCommand, shuttleThread);
|
if (commands == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
List<ShuttleCommand> liftCommand = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, true);
|
if (liftCommand == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车获取顶升命令失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
List<ShuttleCommand> liftCommand2 = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, false);
|
if (liftCommand2 == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车获取下降命令失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
commands.add(0, liftCommand.get(0));
|
commands.add(liftCommand2.get(0));
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.INBOUND_SHUTTLE_RUN.sts);//小车搬运中 4.提升机搬运完成 ==> 5.小车搬运中
|
wrkMast.setModiTime(new Date());
|
wrkMast.setSystemMsg("");//清空消息
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
//触发通知
|
notifyUtils.notify(String.valueOf(SlaveType.Shuttle), shuttleProtocol.getShuttleNo(), String.valueOf(wrkMast.getWrkNo()), wrkMast.getWmsWrkNo(), NotifyMsgType.SHUTTLE_TRANSPORT);
|
return false;
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 出库 ===>> 四向穿梭车出库作业下发
|
*/
|
public synchronized void shuttleOutExecute() {
|
try {
|
List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.in("wrk_sts"
|
, WrkStsType.NEW_OUTBOUND.sts
|
)
|
.orderBy("io_pri", false)
|
.orderBy("appe_time", true)
|
);
|
for (WrkMast wrkMast : wrkMasts) {
|
boolean step1 = this.shuttleOutExecuteStep1(wrkMast);//小车搬出库中
|
Thread.sleep(100);
|
if (!step1) {
|
continue;
|
}
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 出库-小车搬出库中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
public synchronized boolean shuttleOutExecuteStep1(WrkMast wrkMast) {
|
//101.生成出库任务 => 102.小车搬运中
|
if (wrkMast.getWrkSts() == WrkStsType.NEW_OUTBOUND.sts) {
|
Integer liftNo = wrkMast.getLiftNo();
|
if (liftNo == null) {
|
//通过输送线站号获取提升机号
|
liftNo = ForkLiftUtils.getConveyorBindLiftNo(wrkMast.getStaNo());
|
if (liftNo == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，未找到匹配的提升机", wrkMast.getWrkNo());
|
return false;
|
}
|
}
|
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, liftNo);
|
if (forkLiftThread == null) {
|
return false;
|
}
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
return false;
|
}
|
|
//判断提升机是否处于出库模式
|
if (!forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.OUT)) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，提升机不处于出库模式，禁止出库", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//获取源站
|
ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByLev(liftNo, Utils.getLev(wrkMast.getSourceLocNo()));
|
if (liftSta == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，缺少站点信息，禁止派发", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (liftSta.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}站点存在小车，禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo());
|
return false;
|
}
|
|
if (liftSta.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}站点有托盘，禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo());
|
return false;
|
}
|
|
List<WrkMast> shuttleMoveList = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.eq("io_type", 200)
|
);
|
for (WrkMast moveWrkMast : shuttleMoveList) {
|
if(Utils.getLev(moveWrkMast.getLocNo()) != Utils.getLev(wrkMast.getSourceLocNo())) {
|
continue;
|
}
|
|
if(Utils.getLev(moveWrkMast.getLocNo()) == Utils.getLev(moveWrkMast.getSourceLocNo())) {
|
continue;
|
}
|
|
//存在换层任务，出库任务暂时不执行
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，存在换层任务，出库任务等待中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
boolean checkLocPathIsAvailable = navigateUtils.checkLocPathIsAvailable(wrkMast.getSourceLocNo(), liftSta.getLocNo());
|
if(!checkLocPathIsAvailable) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，未计算到可执行路径，等待中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
|
//强制预留一台小车给入库任务
|
int lev = Utils.getLev(wrkMast.getSourceLocNo());
|
//获取当前楼层有几台可用小车
|
int shuttleCount = shuttleDispatchUtils.getShuttleEnableUseCountByLev(lev);
|
if (shuttleCount >= 2) {//只有可用小车数量大于2，才进行入库任务预留小车
|
int shuttleWrkInObligateCount = 1;//预留小车数量
|
Config config = configService.selectOne(new EntityWrapper<Config>().eq("code", "shuttleWrkInObligateCount").eq("status", 1));
|
if (config != null) {
|
shuttleWrkInObligateCount = Integer.parseInt(config.getValue());
|
}
|
//可用出库小车数量(给入库任务预留一台车)
|
int useShuttleCount = shuttleCount - shuttleWrkInObligateCount;
|
//查询楼层已分配车辆的出库任务数量
|
List<WrkMast> wrkMasts = wrkMastService.selectShuttleOutWrkByLev(lev);
|
if (wrkMasts.size() >= useShuttleCount) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，当前楼层可用小车{}台，出库任务已分配{}台，系统等待中。", wrkMast.getWrkNo(), useShuttleCount, wrkMasts.size());
|
return false;
|
}
|
}
|
boolean result = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到货物所在库位进行取货
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，调度小车{}系统等待中。", wrkMast.getWrkNo(), result ? "成功" : "失败");
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
if (!shuttleThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，忙碌中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
//判断小车是否到达货物库位
|
if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) {
|
//检测障碍物车
|
int checkObstacle = shuttleOperaUtils.checkObstacle(wrkMast.getSourceLocNo(), new ArrayList<Integer>() {{
|
add(shuttleProtocol.getShuttleNo());
|
}}, new ArrayList<>());
|
if (checkObstacle > 0) {
|
News.info("{}任务，避障范围有小车，等待障碍小车调离中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//小车不在输送站点位置
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在库位进行取货
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，未到达输送站点，系统等待中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
//检测是否存在移动任务
|
WrkMast moveWorking = wrkMastService.selectShuttleHasMoveWorking(wrkMast.getShuttleNo());
|
if (moveWorking != null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，小车存在移动任务", wrkMast.getWrkNo());
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.TRANSPORT.id);//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
|
//获取小车到输送站点行走命令
|
List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(wrkMast.getSourceLocNo(), liftSta.getLocNo(), NavigationMapType.getDfxWithDevice(), assignCommand, shuttleThread);
|
if (commands == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
List<ShuttleCommand> liftCommand = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, true);
|
if (liftCommand == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车获取顶升命令失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
List<ShuttleCommand> liftCommand2 = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, false);
|
if (liftCommand2 == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车获取下降命令失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
commands.add(0, liftCommand.get(0));
|
commands.add(liftCommand2.get(0));
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.OUTBOUND_SHUTTLE_RUN.sts);//小车搬运中 101.生成出库任务 ==> 102.小车搬运中
|
wrkMast.setSourceStaNo(liftSta.getStaNo());
|
wrkMast.setModiTime(new Date());
|
wrkMast.setSystemMsg("");//清空消息
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
//触发通知
|
notifyUtils.notify(String.valueOf(SlaveType.Shuttle), shuttleProtocol.getShuttleNo(), String.valueOf(wrkMast.getWrkNo()), wrkMast.getWmsWrkNo(), NotifyMsgType.SHUTTLE_TRANSPORT);
|
return false;
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 执行移库任务
|
*/
|
public synchronized void shuttleLocMoveExecute() {
|
try {
|
//查询移库任务
|
List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.in("wrk_sts", WrkStsType.NEW_LOC_MOVE.sts)
|
.orderBy("io_pri", false)
|
.orderBy("appe_time", true)
|
);
|
for (WrkMast wrkMast : wrkMasts) {
|
boolean stepToTarget = this.shuttleLocMoveExecuteToTarget(wrkMast);//移库任务-小车去目标点
|
if (!stepToTarget) {
|
continue;
|
}
|
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 移库任务-小车去目标点
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleLocMoveExecuteToTarget(WrkMast wrkMast) {
|
//--------------------------------------小车移动至站点-----------------------------------------//
|
Date now = new Date();
|
|
//小车移动至站点 501.生成移库任务 ==> 502.小车搬运中
|
if (wrkMast.getWrkSts() == WrkStsType.NEW_LOC_MOVE.sts) {
|
boolean checkLocPathIsAvailable = navigateUtils.checkLocPathIsAvailable(wrkMast.getSourceLocNo(), wrkMast.getLocNo());
|
if(!checkLocPathIsAvailable) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，未计算到可执行路径，等待中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (wrkMast.getShuttleNo() == null) {//没有绑定小车，进行调度
|
boolean result = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo());//调度小车到货物点进行取货
|
News.info("{}任务，调度小车{}系统等待中", wrkMast.getWrkNo(), result ? "成功" : "失败");
|
return false;
|
}
|
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
if (shuttleProtocol.getCurrentLocNo() == null) {
|
return false;
|
}
|
|
//判断小车是否到达货物库位
|
if (!shuttleProtocol.getCurrentLocNo().equals(wrkMast.getSourceLocNo())) {
|
//小车未到达取货位置
|
shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getSourceLocNo(), wrkMast.getShuttleNo());//调度小车到货物所在库位进行取货
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，小车未到达取货位置", wrkMast.getWrkNo(), wrkMast.getSourceLocNo());
|
return false;
|
}
|
|
//检测是否存在移动任务
|
WrkMast moveWorking = wrkMastService.selectShuttleHasMoveWorking(wrkMast.getShuttleNo());
|
if (moveWorking != null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，小车存在移动任务", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//检测障碍物车
|
int checkObstacle = shuttleOperaUtils.checkObstacle(wrkMast.getLocNo(), new ArrayList<Integer>() {{
|
add(shuttleProtocol.getShuttleNo());
|
}}, new ArrayList<>());
|
if (checkObstacle > 0) {
|
News.info("{}任务，避障范围有小车，等待障碍小车调离中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.TRANSPORT.id);//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
assignCommand.setLocNo(wrkMast.getLocNo());
|
|
//获取小车到输送站点行走命令
|
List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(wrkMast.getSourceLocNo(), wrkMast.getLocNo(), NavigationMapType.getMapTypes(NavigationMapType.DFX), assignCommand, shuttleThread);
|
if (commands == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
List<ShuttleCommand> liftCommand = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, true);
|
if (liftCommand == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车获取顶升命令失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
List<ShuttleCommand> liftCommand2 = shuttleOperaUtils.getShuttleLiftCommand(assignCommand, shuttleThread, false);
|
if (liftCommand2 == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车获取下降命令失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
commands.add(0, liftCommand.get(0));
|
commands.add(liftCommand2.get(0));
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.LOC_MOVE_SHUTTLE_RUN.sts);//小车搬运中 501.生成移库任务 ==> 502.小车搬运中
|
wrkMast.setModiTime(now);
|
wrkMast.setSystemMsg("");//清空消息
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
//触发通知
|
notifyUtils.notify(String.valueOf(SlaveType.Shuttle), shuttleProtocol.getShuttleNo(), String.valueOf(wrkMast.getWrkNo()), wrkMast.getWmsWrkNo(), NotifyMsgType.SHUTTLE_MOVING);
|
return false;
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 货叉提升机任务
|
*/
|
public synchronized void forkLiftIoExecute() {
|
try {
|
//搜索是否有待处理的任务
|
List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.in("wrk_sts", WrkStsType.NEW_INBOUND.sts, WrkStsType.OUTBOUND_SHUTTLE_RUN_COMPLETE.sts));
|
if (wrkMasts.isEmpty()) {
|
return;
|
}
|
|
for (WrkMast wrkMast : wrkMasts) {
|
boolean stepIn = this.liftIoExecuteStepIn(wrkMast);//提升机入库
|
if (!stepIn) {
|
continue;
|
}
|
|
boolean stepOut = this.liftIoExecuteStepOut(wrkMast);//提升机出库
|
if (!stepOut) {
|
continue;
|
}
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 提升机入库
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean liftIoExecuteStepIn(WrkMast wrkMast) {
|
//--------------------------------------提升机入库-----------------------------------------//
|
Date now = new Date();
|
|
//1.生成入库任务 ==> 3.提升机搬运中
|
if (wrkMast.getWrkSts() == WrkStsType.NEW_INBOUND.sts) {
|
//获取目标输送站
|
ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
|
if (liftSta == null) {
|
return false;//找不到站点
|
}
|
|
if (liftSta.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在托盘", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (liftSta.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在小车", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//检测楼层是否有可用穿梭车
|
boolean checkLevHasShuttle = Utils.checkLevHasShuttle(liftSta.getLev());
|
if (!checkLevHasShuttle) {
|
if (wrkMast.getShuttleNo() != null) {
|
return false;
|
}
|
|
//获取小车待机位
|
String standbyLocNo = Utils.getShuttleStandbyLocNo(liftSta.getLocNo());
|
if (standbyLocNo == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，获取小车待机位失败", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//调度小车去待机位
|
boolean dispatchShuttle = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), standbyLocNo);
|
if (!dispatchShuttle) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，调度小车失败", wrkMast.getWrkNo());
|
return false;
|
}
|
return false;
|
}
|
|
Integer liftNo = wrkMast.getLiftNo();
|
if (liftNo == null) {
|
//未分配提升机
|
Integer staNo = wrkMast.getSourceStaNo();
|
liftNo = ForkLiftUtils.getConveyorBindLiftNo(staNo);
|
if(liftNo == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，未找到匹配的提升机", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//申请提升机资源
|
boolean applyForkLift = forkLiftAction.applyForkLift(liftNo, wrkMast.getWrkNo());
|
if(!applyForkLift) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，申请提升机资源失败，禁止入库", wrkMast.getWrkNo());
|
return false;
|
}
|
return false;
|
}
|
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, liftNo);
|
if (forkLiftThread == null) {
|
return false;
|
}
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
return false;
|
}
|
if (!forkLiftThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}号提升机，忙碌中", wrkMast.getWrkNo(), liftSta.getLiftNo());
|
return false;
|
}
|
|
//判断提升机是否处于入库模式
|
if (!forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.IN)) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，提升机不处于入库模式，禁止入库", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//请求上级系统，是否允许入库
|
boolean inMission = ForkLiftUtils.queryInMission(wrkMast.getSourceStaNo(), liftSta.getLiftNo(), wrkMast.getWmsWrkNo());
|
if (!inMission) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，上级系统不允许入库", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//获取提升机命令
|
ForkLiftCommand liftCommand = forkLiftThread.getPickAndPutCommand(wrkMast.getWrkNo(), wrkMast.getSourceStaNo(), liftSta.getLev());
|
ArrayList<ForkLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
ForkLiftAssignCommand assignCommand = new ForkLiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(liftNo);
|
assignCommand.setTaskNo(wrkMast.getWrkNo());
|
assignCommand.setTaskMode(ForkLiftTaskModeType.PICK_PUT.id);
|
|
wrkMast.setWrkSts(WrkStsType.INBOUND_LIFT_RUN.sts);//提升机搬运中 1.生成入库任务 ==> 3.提升机搬运中
|
wrkMast.setSystemMsg("");//清空消息
|
wrkMast.setModiTime(now);
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
forkLiftAction.assignWork(wrkMast.getLiftNo(), assignCommand);
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 提升机出库
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean liftIoExecuteStepOut(WrkMast wrkMast) {
|
//--------------------------------------提升机出库-----------------------------------------//
|
//103.小车搬运完成 ==> 104.提升机搬运中
|
if (wrkMast.getWrkSts() == WrkStsType.OUTBOUND_SHUTTLE_RUN_COMPLETE.sts) {
|
//获取源站
|
ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo());
|
if (liftSta == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，找不到站点，禁止派发", wrkMast.getWrkNo());
|
return false;//找不到站点
|
}
|
|
if(wrkMast.getShuttleNo() != null) {
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if(shuttleProtocol == null) {
|
return false;
|
}
|
|
if (shuttleProtocol.getCurrentLocNo().equals(liftSta.getLocNo())) {
|
//小车还在输送站点
|
//获取小车待机位
|
String standbyLocNo = Utils.getShuttleStandbyLocNo(liftSta.getLocNo());
|
if (standbyLocNo == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，获取小车待机位失败", wrkMast.getWrkNo());
|
return false;
|
}
|
//调度小车去待机位
|
boolean dispatchShuttle = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), standbyLocNo, wrkMast.getShuttleNo());
|
if (!dispatchShuttle) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，小车在输送站点调度小车避让失败", wrkMast.getWrkNo());
|
return false;
|
}
|
} else {
|
//小车已不在输送站点位置，释放小车
|
wrkMast.setShuttleNo(null);//释放小车
|
wrkMast.setModiTime(new Date());
|
wrkMastService.updateById(wrkMast);
|
return false;
|
}
|
return false;
|
}
|
|
if (liftSta.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}站点存在小车，禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo());
|
return false;
|
}
|
|
if (!liftSta.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}站点无托盘，禁止派发", wrkMast.getWrkNo(), liftSta.getStaNo());
|
return false;
|
}
|
|
Integer liftNo = wrkMast.getLiftNo();
|
if (liftNo == null) {
|
//未分配提升机
|
Integer staNo = wrkMast.getStaNo();
|
liftNo = ForkLiftUtils.getConveyorBindLiftNo(staNo);
|
if(liftNo == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，未找到匹配的提升机", wrkMast.getWrkNo());
|
return false;
|
}
|
//申请提升机资源
|
boolean applyForkLift = forkLiftAction.applyForkLift(liftSta.getLiftNo(), wrkMast.getWrkNo());
|
if(!applyForkLift) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，申请提升机资源失败，禁止执行出库", wrkMast.getWrkNo());
|
return false;
|
}
|
return false;
|
}
|
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, liftNo);
|
if (forkLiftThread == null) {
|
return false;
|
}
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
return false;
|
}
|
if (!forkLiftThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}号提升机，忙碌中", wrkMast.getWrkNo(), liftSta.getLiftNo());
|
return false;
|
}
|
|
//判断提升机是否处于出库模式
|
if (!forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.OUT)) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，提升机不处于出库模式，禁止出库", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//请求上级系统，是否允许出库
|
boolean outMission = ForkLiftUtils.queryOutMission(wrkMast.getStaNo());
|
if (!outMission) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，上级系统不允许出库", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//获取提升机命令
|
ForkLiftCommand liftCommand = forkLiftThread.getPickAndPutCommand(wrkMast.getWrkNo(), liftSta.getLev(), wrkMast.getStaNo());
|
ArrayList<ForkLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
ForkLiftAssignCommand assignCommand = new ForkLiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(liftNo);
|
assignCommand.setTaskNo(wrkMast.getWrkNo());
|
assignCommand.setTaskMode(ForkLiftTaskModeType.PICK_PUT.id);
|
|
wrkMast.setWrkSts(WrkStsType.OUTBOUND_LIFT_RUN.sts);//提升机搬运中 103.生成入库任务 ==> 104.提升机搬运中
|
wrkMast.setShuttleNo(null);//释放小车
|
wrkMast.setSystemMsg("");//清空消息
|
wrkMast.setModiTime(new Date());
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
forkLiftAction.assignWork(wrkMast.getLiftNo(), assignCommand);
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 货叉提升机任务完成
|
*/
|
public synchronized void forkLiftFinished() {
|
try {
|
List<DeviceConfig> forkliftList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
|
.eq("device_type", String.valueOf(SlaveType.ForkLift)));
|
for (DeviceConfig device : forkliftList) {
|
//获取提升机信息
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, device.getDeviceNo());
|
if(forkLiftThread == null) {
|
continue;
|
}
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
continue;
|
}
|
|
//提升机为等待确认且空闲
|
if (forkLiftProtocol.getProtocolStatus() == ForkLiftProtocolStatusType.WAITING.id
|
&& forkLiftProtocol.getWrkNo() != 0
|
) {
|
//将任务档标记为完成
|
WrkMast wrkMast = wrkMastService.selectByWorkNo(forkLiftProtocol.getWrkNo());
|
if (wrkMast != null) {
|
if (wrkMast.getWrkSts() == WrkStsType.INBOUND_LIFT_RUN.sts) {
|
//3.提升机搬运中 ==> 4.提升机搬运完成
|
wrkMast.setWrkSts(WrkStsType.INBOUND_LIFT_RUN_COMPLETE.sts);
|
wrkMast.setLiftNo(null);//释放提升机
|
forkLiftThread.setSyncTaskNo(0);
|
} else if (wrkMast.getWrkSts() == WrkStsType.OUTBOUND_LIFT_RUN.sts) {
|
//104.提升机搬运中 ==> 109.出库完成
|
wrkMast.setWrkSts(WrkStsType.COMPLETE_OUTBOUND.sts);
|
wrkMast.setLiftNo(null);//释放提升机
|
forkLiftThread.setSyncTaskNo(0);
|
redisUtil.set(RedisKeyType.FORK_LIFT_PUT_COMPLETE.key + forkLiftProtocol.getLiftNo(), wrkMast.getWmsWrkNo(), 60 * 3);
|
} else if (wrkMast.getWrkSts() == WrkStsType.MOVE_LIFT_RUN.sts) {
|
//306.提升机搬运中 ==> 307.提升机搬运完成
|
wrkMast.setWrkSts(WrkStsType.MOVE_LIFT_RUN_COMPLETE.sts);
|
forkLiftThread.setSyncTaskNo(0);
|
}
|
wrkMast.setModiTime(new Date());
|
if (wrkMastService.updateById(wrkMast)) {
|
forkLiftThread.reset();
|
News.info("提升机已确认且任务完成状态。提升机号={}", forkLiftProtocol.getLiftNo());
|
} else {
|
News.error("提升机已确认且任务完成状态,复位失败，但未找到工作档。提升机号={}，工作号={}", forkLiftProtocol.getLiftNo(), forkLiftProtocol.getWrkNo());
|
}
|
}else {
|
boolean checkPreviewDispatchForkLift = commonService.checkWorkNoContainMk(forkLiftProtocol.getWrkNo(), WrkIoType.PREVIEW_LIFT_MOVE.id);
|
if (checkPreviewDispatchForkLift) {
|
//属于提升机预调度移动任务
|
//无工作档支撑，直接确认完成
|
forkLiftThread.setSyncTaskNo(0);
|
forkLiftThread.reset();
|
News.info("已确认提升机预调度移动任务。提升机号={}", forkLiftProtocol.getLiftNo());
|
}
|
}
|
}
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 异常信息记录
|
*/
|
public void recErr() {
|
try {
|
this.recShuttleErr();
|
this.recLiftErr();
|
} catch (Exception e) {
|
News.error("recErr fail", e);
|
}
|
}
|
|
/**
|
* 四向穿梭车异常信息记录
|
*/
|
private void recShuttleErr() {
|
Date now = new Date();
|
List<DeviceConfig> shuttleList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
|
.eq("device_type", String.valueOf(SlaveType.Shuttle)));
|
for (DeviceConfig device : shuttleList) {
|
// 获取四向穿梭车信息
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getDeviceNo());
|
if (shuttleThread == null) {
|
continue;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
if (shuttleProtocol.getTaskNo() != 0) {
|
//有任务
|
BasShuttleErrLog latest = basShuttleErrLogService.findLatestByTaskNo(device.getDeviceNo(), shuttleProtocol.getTaskNo());
|
// 有异常
|
if (latest == null) {
|
if (shuttleProtocol.getErrorCode() != null && Integer.parseInt(shuttleProtocol.getErrorCode()) != 0) {
|
WrkMast wrkMast = wrkMastService.selectByWorkNo(shuttleProtocol.getTaskNo());
|
if (wrkMast == null) {
|
continue;
|
}
|
int errorCode = Integer.parseInt(shuttleProtocol.getErrorCode());
|
BasShuttleErr basShuttleErr = basShuttleErrService.queryByCode(errorCode);
|
String errName = basShuttleErr==null? "未知异常":basShuttleErr.getErrName();
|
BasShuttleErrLog basShuttleErrLog = new BasShuttleErrLog(
|
null, // 编号
|
wrkMast.getWrkNo(), // 工作号
|
now, // 发生时间
|
null, // 结束时间
|
wrkMast.getWrkSts(), // 工作状态
|
wrkMast.getIoType(), // 入出库类型
|
device.getDeviceNo(), // 四向穿梭车
|
null, // plc
|
wrkMast.getLocNo(), // 目标库位
|
wrkMast.getStaNo(), // 目标站
|
wrkMast.getSourceStaNo(), // 源站
|
wrkMast.getSourceLocNo(), // 源库位
|
wrkMast.getBarcode(), // 条码
|
errorCode, // 异常码
|
errName, // 异常
|
1, // 异常情况
|
now, // 添加时间
|
null, // 添加人员
|
now, // 修改时间
|
null, // 修改人员
|
"任务中异常", // 备注
|
JSON.toJSONString(shuttleProtocol) // 系统状态数据
|
);
|
if (!basShuttleErrLogService.insert(basShuttleErrLog)) {
|
News.error("四向穿梭车plc异常记录失败 ===>> [id:{}] [error:{}]", device.getDeviceNo(), errName);
|
}
|
}
|
} else {
|
// 异常修复
|
if (shuttleProtocol.getErrorCode() == null || Integer.parseInt(shuttleProtocol.getErrorCode()) == 0) {
|
latest.setEndTime(now);
|
latest.setUpdateTime(now);
|
latest.setStatus(2);
|
if (!basShuttleErrLogService.updateById(latest)) {
|
News.error("四向穿梭车plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", device.getDeviceNo(), latest.getId());
|
}
|
}
|
}
|
}
|
}
|
}
|
|
/**
|
* 提升机异常信息记录
|
*/
|
private void recLiftErr() {
|
Date now = new Date();
|
List<DeviceConfig> forkliftList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
|
.eq("device_type", String.valueOf(SlaveType.ForkLift)));
|
for (DeviceConfig device : forkliftList) {
|
// 获取提升机信息
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, device.getDeviceNo());
|
if (forkLiftThread == null) {
|
continue;
|
}
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
continue;
|
}
|
|
if (forkLiftProtocol.getTaskNo() != 0) {
|
//有任务
|
BasLiftErrLog latest = basLiftErrLogService.findLatestByTaskNo(device.getDeviceNo(), forkLiftProtocol.getTaskNo());
|
// 有异常
|
if (latest == null) {
|
if (forkLiftProtocol.getErrorCode() != null && forkLiftProtocol.getErrorCode() != 0) {
|
WrkMast wrkMast = wrkMastService.selectByWorkNo(forkLiftProtocol.getWrkNo());
|
if (wrkMast == null) {
|
continue;
|
}
|
|
BasLiftErr basLiftErr = basLiftErrService.queryByCode(forkLiftProtocol.getErrorCode());
|
String errName = basLiftErr==null? "未知异常":basLiftErr.getErrName();
|
|
BasLiftErrLog basLiftErrLog = new BasLiftErrLog(
|
null, // 编号
|
wrkMast.getWrkNo(), // 工作号
|
now, // 发生时间
|
null, // 结束时间
|
wrkMast.getWrkSts(), // 工作状态
|
wrkMast.getIoType(), // 入出库类型
|
device.getDeviceNo(), // 提升机
|
null, // plc
|
wrkMast.getLocNo(), // 目标库位
|
wrkMast.getStaNo(), // 目标站
|
wrkMast.getSourceStaNo(), // 源站
|
wrkMast.getSourceLocNo(), // 源库位
|
wrkMast.getBarcode(), // 条码
|
null, // 异常码
|
errName, // 异常
|
1, // 异常情况
|
now, // 添加时间
|
null, // 添加人员
|
now, // 修改时间
|
null, // 修改人员
|
"任务中异常", // 备注
|
JSON.toJSONString(forkLiftProtocol) // 系统状态数据
|
);
|
if (!basLiftErrLogService.insert(basLiftErrLog)) {
|
News.error("提升机plc异常记录失败 ===>> [id:{}] [error:{}]", device.getDeviceNo(), errName);
|
}
|
}
|
} else {
|
// 异常修复
|
if (forkLiftProtocol.getErrorCode() == null || forkLiftProtocol.getErrorCode() == 0) {
|
latest.setEndTime(now);
|
latest.setUpdateTime(now);
|
latest.setStatus(2);
|
if (!basLiftErrLogService.updateById(latest)) {
|
News.error("提升机plc异常记录修复失败 ===>> [id:{}] [errLogId:{}]", device.getDeviceNo(), latest.getId());
|
}
|
}
|
}
|
}
|
}
|
}
|
|
/**
|
* 四向穿梭车电量检测 ===>> 发起充电
|
*/
|
public synchronized void loopShuttleCharge() {
|
try {
|
|
List<BasShuttleCharge> charges = basShuttleChargeService.selectList(new EntityWrapper<BasShuttleCharge>().orderBy("charge_id", true));
|
if (charges.isEmpty()) {
|
return;//无充电桩
|
}
|
|
List<DeviceConfig> shuttleList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
|
.eq("device_type", String.valueOf(SlaveType.Shuttle)));
|
for (DeviceConfig device : shuttleList) {
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, device.getDeviceNo());
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
//判断当前小车是否满足需要充电要求
|
if (!shuttleThread.isRequireCharge()) {
|
continue;
|
}
|
|
WrkMast wrkMast1 = wrkMastService.selectShuttleWorking(shuttleProtocol.getShuttleNo());
|
if (wrkMast1 != null) {
|
continue;
|
}
|
|
WrkMast wrkMast2 = wrkMastService.selectShuttleHasMoveWorking(shuttleProtocol.getShuttleNo());
|
if (wrkMast2 != null) {
|
continue;
|
}
|
|
WrkMast wrkMast = wrkMastService.selectChargeWorking(shuttleProtocol.getShuttleNo());
|
if (wrkMast != null) {//已有充电任务
|
continue;
|
}
|
|
//小车所在楼层
|
int lev = Utils.getLev(shuttleProtocol.getCurrentLocNo());
|
BasShuttleCharge shuttleCharge = null;
|
|
//搜索小车所在楼层有没有充电桩
|
for (BasShuttleCharge charge : charges) {
|
if (lev != Utils.getLev(charge.getLocNo())) {
|
continue;//小车和充电桩不在同一层
|
}
|
|
if (charge.getStatus() == 0) {
|
continue;//充电桩被禁用
|
}
|
|
//小车和充电桩在同一层
|
if (wrkMastService.selectChargeWorkingByChargeSta(charge.getChargeId()) == null) {
|
shuttleCharge = charge;
|
break;
|
}
|
}
|
|
if (shuttleCharge == null) {
|
//同楼层没有找到充电桩，找可用充电桩
|
//小车同楼层没有充电桩，只要充电桩可用就生成充电任务
|
for (BasShuttleCharge charge : charges) {
|
if (wrkMastService.selectChargeWorkingByChargeSta(charge.getChargeId()) == null) {
|
//判断当前充电桩是否有小车，如有小车，不分配该充电桩
|
ArrayList<String> locs = new ArrayList<>();
|
locs.add(charge.getLocNo());
|
Integer checkHasShuttle = Utils.checkGroupLocHasShuttle(locs);
|
if(checkHasShuttle != null) {
|
//当前充电桩有穿梭车，不分配该充电桩
|
continue;
|
}
|
|
if (charge.getStatus() == 0) {
|
continue;//充电桩被禁用
|
}
|
|
shuttleCharge = charge;
|
break;
|
}
|
}
|
}
|
|
if (shuttleCharge == null) {
|
continue;
|
}
|
|
String chargeLocNo = shuttleCharge.getLocNo();
|
wrkMast = new WrkMast();
|
wrkMast.setMk(String.valueOf(shuttleCharge.getChargeId()));
|
wrkMast.setWrkNo(commonService.getWorkNo(WrkIoType.SHUTTLE_CHARGE.id));
|
wrkMast.setWrkSts(WrkStsType.NEW_CHARGE.sts);
|
wrkMast.setIoType(WrkIoType.SHUTTLE_CHARGE.id);//300.充电
|
wrkMast.setIoPri((double) 999);
|
wrkMast.setLocNo(chargeLocNo);
|
wrkMast.setShuttleNo(device.getDeviceNo());
|
wrkMast.setMemo("charge");
|
wrkMast.setAppeTime(new Date());
|
if (!wrkMastService.insert(wrkMast)) {
|
News.error("保存{}号四向穿梭车充电任务失败!!!", device.getDeviceNo());
|
continue;
|
}
|
|
News.info("保存{}号四向穿梭车充电任务成功!!!", device.getDeviceNo());
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 执行四向穿梭车充电任务
|
*/
|
public synchronized void executeShuttleCharge() {
|
try {
|
//查询小车充电任务
|
List<DeviceConfig> shuttleList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
|
.eq("device_type", String.valueOf(SlaveType.Shuttle)));
|
for (DeviceConfig device : shuttleList) {
|
WrkMast wrkMast = wrkMastService.selectChargeWorking(device.getDeviceNo());
|
if(wrkMast == null) {
|
continue;
|
}
|
|
boolean result1 = this.executeShuttleChargeStepGoToChargeSta(wrkMast);//小车等待充电桩
|
if (!result1) {
|
continue;
|
}
|
|
boolean result2 = this.executeShuttleChargeStepArrivalChargeSta(wrkMast);//小车到达充电桩
|
if (!result2) {
|
continue;
|
}
|
|
boolean result3 = this.executeShuttleChargeStepStartCharge(wrkMast);//小车开始充电
|
if (!result3) {
|
continue;
|
}
|
|
boolean result4 = this.executeShuttleChargeStepStopCharge(wrkMast);//小车停止充电
|
if (!result4) {
|
continue;
|
}
|
|
boolean result5 = this.executeShuttleChargeStepLeaveCharge(wrkMast);//小车离开充电桩
|
if (!result5) {
|
continue;
|
}
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 小车前往充电桩
|
*/
|
private synchronized boolean executeShuttleChargeStepGoToChargeSta(WrkMast wrkMast) {
|
if (wrkMast.getWrkSts() == WrkStsType.NEW_CHARGE.sts) {
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
if (wrkMast.getLocNo().equals(shuttleProtocol.getCurrentLocNo())) {
|
//小车在充电桩位置
|
wrkMast.setWrkSts(WrkStsType.CHARGE_SHUTTLE_RUN_COMPLETE.sts);
|
wrkMast.setModiTime(new Date());
|
wrkMastService.updateById(wrkMast);
|
return false;
|
}
|
|
//调度小车去充电桩
|
boolean dispatched = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), wrkMast.getLocNo(), wrkMast.getShuttleNo());
|
if (!dispatched) {
|
return false;
|
}
|
|
wrkMast.setWrkSts(WrkStsType.CHARGE_SHUTTLE_RUN.sts);//小车前往充电桩
|
wrkMast.setModiTime(new Date());
|
wrkMastService.updateById(wrkMast);
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 小车到达充电桩
|
*/
|
private synchronized boolean executeShuttleChargeStepArrivalChargeSta(WrkMast wrkMast) {
|
if (wrkMast.getWrkSts() == WrkStsType.CHARGE_SHUTTLE_RUN.sts) {
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//判断是否存在未完成的移动任务
|
WrkMast moveWrk = wrkMastService.selectShuttleHasMoveWorking(wrkMast.getShuttleNo());
|
if(moveWrk != null) {
|
return false;
|
}
|
|
if (!wrkMast.getLocNo().equals(shuttleProtocol.getCurrentLocNo())) {
|
return false;
|
}
|
|
//小车在充电桩位置
|
wrkMast.setWrkSts(WrkStsType.CHARGE_SHUTTLE_RUN_COMPLETE.sts);//小车到达充电桩
|
wrkMast.setModiTime(new Date());
|
wrkMastService.updateById(wrkMast);
|
|
return false;
|
}
|
return true;
|
}
|
|
//小车开始充电
|
private synchronized boolean executeShuttleChargeStepStartCharge(WrkMast wrkMast) {
|
if (wrkMast.getWrkSts() == WrkStsType.CHARGE_SHUTTLE_RUN_COMPLETE.sts) {
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车已经在充电桩位置，下发充电命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE_ON.id);//充电开
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
|
List<ShuttleCommand> commands = shuttleOperaUtils.getShuttleChargeCommand(assignCommand, shuttleThread, true);
|
assignCommand.setCommands(commands);//运行命令
|
|
wrkMast.setWrkSts(WrkStsType.CHARGE_SHUTTLE_WORKING.sts);
|
wrkMast.setModiTime(new Date());
|
if (!wrkMastService.updateById(wrkMast)) {
|
return false;
|
}
|
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
|
notifyUtils.notify(String.valueOf(SlaveType.Shuttle), shuttleProtocol.getShuttleNo(), String.valueOf(wrkMast.getWrkNo()), wrkMast.getWmsWrkNo(), NotifyMsgType.SHUTTLE_POWER_START);//触发通知
|
return false;
|
}
|
return true;
|
}
|
|
//小车停止充电
|
private synchronized boolean executeShuttleChargeStepStopCharge(WrkMast wrkMast) {
|
if (wrkMast.getWrkSts() == WrkStsType.CHARGE_SHUTTLE_WORKING.sts) {
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
if (!shuttleThread.isChargingCompleted()) {
|
return false;
|
}
|
|
//小车已经在充电桩位置，下发停止充电命令
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo());//四向穿梭车号
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setTaskMode(ShuttleTaskModeType.CHARGE_OFF.id);//充电关
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位(小车当前位置)
|
|
List<ShuttleCommand> commands = shuttleOperaUtils.getShuttleChargeCommand(assignCommand, shuttleThread, false);
|
assignCommand.setCommands(commands);//运行命令
|
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
return false;
|
}
|
return true;
|
}
|
|
//小车离开充电桩
|
private synchronized boolean executeShuttleChargeStepLeaveCharge(WrkMast wrkMast) {
|
if (wrkMast.getWrkSts() == WrkStsType.CHARGE_SHUTTLE_COMPLETE.sts) {
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
BasShuttleCharge basShuttleCharge = basShuttleChargeService.selectOne(new EntityWrapper<BasShuttleCharge>().eq("charge_id", wrkMast.getMk()));
|
if(basShuttleCharge == null) {
|
return false;
|
}
|
|
//检测障碍物车
|
int checkObstacle = shuttleOperaUtils.checkObstacle(basShuttleCharge.getWaitLocNo(), new ArrayList<Integer>() {{
|
add(shuttleProtocol.getShuttleNo());
|
}}, new ArrayList<>());
|
if (checkObstacle > 0) {
|
News.info("{}任务，避障范围有小车，等待障碍小车调离中", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//调度小车去待机位
|
boolean dispatched = shuttleDispatchUtils.dispatchShuttle(wrkMast.getWrkNo(), basShuttleCharge.getWaitLocNo(), wrkMast.getShuttleNo());
|
if (!dispatched) {
|
return false;
|
}
|
|
wrkMast.setWrkSts(WrkStsType.COMPLETE_CHARGE.sts);
|
wrkMast.setModiTime(new Date());
|
if (wrkMastService.updateById(wrkMast)) {
|
return false;
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 执行小车移库任务
|
*/
|
public synchronized void shuttleMoveExecute() {
|
try {
|
//查询小车移库任务
|
List<WrkMast> wrkMasts = wrkMastService.selectShuttleMoveWrk();
|
for (WrkMast wrkMast : wrkMasts) {
|
boolean stepMoveNearby = this.shuttleMoveExecuteStepMoveNearby(wrkMast);//小车移动到近点
|
if (!stepMoveNearby) {
|
continue;
|
}
|
|
boolean stepMoveInLift = this.shuttleMoveExecuteStepMoveInLift(wrkMast);//小车迁入提升机中
|
if (!stepMoveInLift) {
|
continue;
|
}
|
|
boolean stepLiftMove = this.shuttleMoveExecuteStepLiftMove(wrkMast);//提升机搬运中
|
if (!stepLiftMove) {
|
continue;
|
}
|
|
boolean updateShuttleLocation = this.shuttleMoveExecuteStepUpdateShuttleLocation(wrkMast);//提升机搬运完成更新小车坐标
|
if (!updateShuttleLocation) {
|
continue;
|
}
|
|
boolean stepMoveLoc = this.shuttleMoveExecuteStepMoveLoc(wrkMast);//小车移动到目标库位中
|
if (!stepMoveLoc) {
|
continue;
|
}
|
|
}
|
} catch (Exception e) {
|
e.printStackTrace();
|
}
|
}
|
|
/**
|
* 小车迁移-小车移动到近点中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStepMoveNearby(WrkMast wrkMast) {
|
//--------------------------------------小车移动到近点中-----------------------------------------//
|
Date now = new Date();
|
|
//小车移动到近点 301.生成小车移库任务 ==> 302.小车移动至站点中
|
if (wrkMast.getWrkSts() == WrkStsType.NEW_MOVE.sts) {
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，小车忙碌中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
if (Utils.getLev(wrkMast.getLocNo()) == Utils.getLev(shuttleProtocol.getCurrentLocNo())) {
|
//目标库位和小车库位处于同一楼层，不需要通过提升机调度
|
wrkMast.setWrkSts(WrkStsType.MOVE_OUT_LIFT_COMPLETE.sts);// 309.小车迁出提升机完成 ==> 310.小车移动中
|
wrkMast.setModiTime(now);
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
return true;//直接进入309.小车迁出提升机完成 ==> 310.小车移动中
|
}
|
return false;
|
}
|
|
//搜索最近且无故障提升机
|
ForkLiftStaProtocol recentLiftStation = forkLiftDispatchUtils.getRecentLiftStation(shuttleProtocol.getShuttleNo(), Utils.getLev(wrkMast.getLocNo()));
|
if(recentLiftStation == null) {
|
News.info("{}号小车，{}目标库位，没有可用空闲输送站点", shuttleProtocol.getShuttleNo(), wrkMast.getLocNo());
|
return false;
|
}
|
|
if (recentLiftStation.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，源站存在托盘", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (recentLiftStation.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，源站存在小车", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//获取目标输送站
|
ForkLiftStaProtocol liftStaTarget = ForkLiftUtils.getLiftStaByLev(recentLiftStation.getLiftNo(), Utils.getLev(wrkMast.getLocNo()));
|
if (liftStaTarget == null) {
|
return false;//找不到站点
|
}
|
|
if (liftStaTarget.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在托盘", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (liftStaTarget.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在小车", wrkMast.getWrkNo());
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.MOVE_LOC_NO.id);//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
|
//计算近点位置
|
String endLocation = navigateUtils.calcEndLocation(shuttleProtocol.getCurrentLocNo(), recentLiftStation.getLocNo(), NavigationMapType.getMapTypes(NavigationMapType.NORMAL), null, null, 1);
|
if (endLocation == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，小车近点位置计算失败", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//小车已在近点位置无需前往
|
if (shuttleProtocol.getCurrentLocNo().equals(endLocation)) {
|
wrkMast.setWrkSts(WrkStsType.MOVE_NEARBY_COMPLETE.sts);//小车移动到提升机中 301.生成小车移库任务 ==> 303.小车移动至近点完成
|
wrkMast.setModiTime(now);
|
wrkMast.setSystemMsg("");//清空消息
|
wrkMastService.updateById(wrkMast);
|
return true;
|
}
|
|
//获取小车到近点行走命令
|
List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getCurrentLocNo(), endLocation, NavigationMapType.getMapTypes(NavigationMapType.NORMAL, NavigationMapType.SHUTTLE), assignCommand, shuttleThread);
|
if (commands == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;//路径解锁失败
|
}
|
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.MOVE_NEARBY.sts);//小车移动到提升机中 301.生成小车移库任务 ==> 302.小车移动至近点中
|
wrkMast.setSourceStaNo(recentLiftStation.getStaNo());
|
wrkMast.setStaNo(liftStaTarget.getStaNo());
|
wrkMast.setModiTime(now);
|
wrkMast.setSystemMsg("");//清空消息
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
notifyUtils.notify(String.valueOf(SlaveType.Shuttle), shuttleProtocol.getShuttleNo(), String.valueOf(wrkMast.getWrkNo()), wrkMast.getWmsWrkNo(), NotifyMsgType.SHUTTLE_MOVING);
|
//触发通知
|
return false;
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-小车迁入提升机中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStepMoveInLift(WrkMast wrkMast) {
|
//--------------------------------------小车迁入提升机中-----------------------------------------//
|
Date now = new Date();
|
|
//小车迁入提升机 303.小车移动至近点完成 ==> 304.小车迁入提升机中
|
if (wrkMast.getWrkSts() == WrkStsType.MOVE_NEARBY_COMPLETE.sts) {
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，小车忙碌中", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
//获取源输送站
|
ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo());
|
if (liftSta == null) {
|
return false;//找不到站点
|
}
|
|
if (liftSta.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，源站存在托盘", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (liftSta.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，源站存在小车", wrkMast.getWrkNo());
|
return false;
|
}
|
|
//获取目标输送站
|
ForkLiftStaProtocol liftStaTarget = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
|
if (liftStaTarget == null) {
|
return false;//找不到站点
|
}
|
|
if (liftStaTarget.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在托盘", wrkMast.getWrkNo());
|
return false;
|
}
|
|
if (liftStaTarget.getHasCar()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在小车", wrkMast.getWrkNo());
|
return false;
|
}
|
|
List<WrkMast> outWrkMastList = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.eq("io_type", 101)
|
.in("wrk_sts"
|
, WrkStsType.OUTBOUND_SHUTTLE_RUN.sts
|
, WrkStsType.OUTBOUND_SHUTTLE_RUN_COMPLETE.sts
|
, WrkStsType.OUTBOUND_LIFT_RUN.sts
|
, WrkStsType.OUTBOUND_LIFT_RUN_COMPLETE.sts
|
)
|
);
|
for (WrkMast outWrkMast : outWrkMastList) {
|
if(Utils.getLev(outWrkMast.getSourceLocNo()) == Utils.getLev(wrkMast.getLocNo())) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，存在正在执行的小车出库任务，禁止移动至站点", wrkMast.getWrkNo());
|
return false;
|
}
|
}
|
|
if (wrkMast.getLiftNo() == null) {
|
//申请提升机资源(该任务需要换层必须提前独占提升机)
|
boolean applyForkLift = forkLiftAction.applyForkLift(liftSta.getLiftNo(), wrkMast.getWrkNo());
|
if(!applyForkLift) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，申请提升机资源失败，禁止移动至站点", wrkMast.getWrkNo());
|
return false;
|
}
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.MOVE_LOC_NO.id);//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
|
//获取小车到提升机行走命令
|
List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getCurrentLocNo(), liftSta.getLocNo(), NavigationMapType.getMapTypes(NavigationMapType.NORMAL), assignCommand, shuttleThread);
|
if (commands == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;//路径解锁失败
|
}
|
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.MOVE_IN_LIFT.sts);//303.小车移动至近点完成 ==> 304.小车迁入提升机中
|
wrkMast.setModiTime(now);
|
wrkMast.setSystemMsg("");//清空消息
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
notifyUtils.notify(String.valueOf(SlaveType.Shuttle), shuttleProtocol.getShuttleNo(), String.valueOf(wrkMast.getWrkNo()), wrkMast.getWmsWrkNo(), NotifyMsgType.SHUTTLE_MOVING);
|
//触发通知
|
return false;
|
}
|
return false;
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-提升机搬运中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStepLiftMove(WrkMast wrkMast) {
|
//--------------------------------------提升机搬运中-----------------------------------------//
|
Date now = new Date();
|
|
//提升机搬运中 305.小车迁入提升机完成 ==> 306.提升机搬运中
|
if (wrkMast.getWrkSts() == WrkStsType.MOVE_IN_LIFT_COMPLETE.sts) {
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, wrkMast.getLiftNo());
|
if (forkLiftThread == null) {
|
return false;
|
}
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
return false;
|
}
|
if (!forkLiftThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}号提升机，提升机忙碌中，禁止派发", wrkMast.getWrkNo(), wrkMast.getLiftNo());
|
return false;
|
}
|
|
//获取源站
|
ForkLiftStaProtocol sourceLiftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getSourceStaNo());
|
//获取目标站
|
ForkLiftStaProtocol liftSta = ForkLiftUtils.getLiftStaByStaNo(wrkMast.getStaNo());
|
if (sourceLiftSta == null || liftSta == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，缺少站点信息，禁止派发", wrkMast.getWrkNo());
|
return false;//缺少站点信息
|
}
|
|
if (liftSta.getHasTray()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，目标站存在托盘，禁止派发", wrkMast.getWrkNo());
|
return false;//有托盘跳过
|
}
|
|
//获取提升机命令
|
ForkLiftCommand liftCommand = forkLiftThread.getShuttleSwitchCommand(wrkMast.getWrkNo(), sourceLiftSta.getLev(), liftSta.getLev());
|
ArrayList<ForkLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
ForkLiftAssignCommand assignCommand = new ForkLiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(wrkMast.getLiftNo());
|
assignCommand.setTaskNo(wrkMast.getWrkNo());
|
assignCommand.setTaskMode(ForkLiftTaskModeType.SHUTTLE_SWITCH.id);
|
|
wrkMast.setWrkSts(WrkStsType.MOVE_LIFT_RUN.sts);//提升机搬运中 305.小车迁入提升机完成 ==> 306.提升机搬运中
|
wrkMast.setSystemMsg("");//清空消息
|
wrkMast.setModiTime(now);
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
forkLiftAction.assignWork(wrkMast.getLiftNo(), assignCommand);
|
}
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-提升机搬运完成更新小车坐标
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStepUpdateShuttleLocation(WrkMast wrkMast) {
|
//--------------------------------------提升机搬运中-----------------------------------------//
|
Date now = new Date();
|
|
//提升机搬运中 307.提升机搬运完成 ==> 308.小车迁出提升机中
|
if (wrkMast.getWrkSts() == WrkStsType.MOVE_LIFT_RUN_COMPLETE.sts) {
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，小车忙碌中，禁止派发", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.UPDATE_LOCATION.id);//更新坐标
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位
|
assignCommand.setLocNo(wrkMast.getLocNo());//目标库位
|
|
//更新小车坐标
|
ShuttleCommand command = shuttleThread.getUpdateLocationCommand(wrkMast.getWrkNo(), wrkMast.getLocNo());
|
ArrayList<ShuttleCommand> commands = new ArrayList<>();
|
commands.add(command);
|
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.MOVE_OUT_LIFT.sts);//小车迁出提升机中
|
wrkMast.setSystemMsg("");//清空消息
|
wrkMast.setModiTime(now);
|
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
}
|
}
|
return true;
|
}
|
|
/**
|
* 小车迁移-小车移动到目标库位中
|
* 如需主方法执行continue，请返回false
|
* ps:返回值true并不代表该方法执行成功，返回值仅做标记用于主方法是否执行continue
|
*/
|
private boolean shuttleMoveExecuteStepMoveLoc(WrkMast wrkMast) {
|
//--------------------------------------小车移动到目标库位中-----------------------------------------//
|
Date now = new Date();
|
|
//小车移动到目标库位中 309.小车迁出提升机完成 ==> 310.小车移动中
|
if (wrkMast.getWrkSts() == WrkStsType.MOVE_OUT_LIFT_COMPLETE.sts) {
|
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
return false;
|
}
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
return false;
|
}
|
|
//小车处于空闲状态
|
if (!shuttleThread.isIdle()) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，小车忙碌中，禁止派发", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;
|
}
|
|
//小车已经在目标库位，直接认定小车移动任务完成
|
if (shuttleProtocol.getCurrentLocNo().equals(wrkMast.getLocNo())) {
|
wrkMast.setWrkSts(WrkStsType.COMPLETE_MOVE.sts);//311.小车移动完成
|
wrkMast.setLiftNo(null);//释放提升机
|
wrkMast.setModiTime(now);
|
wrkMastService.updateById(wrkMast);
|
return false;
|
}
|
|
ShuttleAssignCommand assignCommand = new ShuttleAssignCommand();
|
assignCommand.setShuttleNo(shuttleProtocol.getShuttleNo()); // 四向穿梭车编号
|
assignCommand.setTaskMode(ShuttleTaskModeType.MOVE_LOC_NO.id);//小车移库任务
|
assignCommand.setTaskNo(wrkMast.getWrkNo());//任务号
|
assignCommand.setAuto(true);//自动模式
|
assignCommand.setSourceLocNo(shuttleProtocol.getCurrentLocNo());//源库位
|
assignCommand.setLocNo(wrkMast.getLocNo());//目标库位
|
|
//获取小车到目标库位命令
|
List<ShuttleCommand> commands = shuttleOperaUtils.getStartToTargetCommands(shuttleProtocol.getCurrentLocNo(), wrkMast.getLocNo(), NavigationMapType.getMapTypes(NavigationMapType.NORMAL), assignCommand, shuttleThread);
|
if (commands == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，{}小车，路径计算失败", wrkMast.getWrkNo(), shuttleProtocol.getShuttleNo());
|
return false;//路径计算失败
|
}
|
|
assignCommand.setCommands(commands);
|
|
wrkMast.setWrkSts(WrkStsType.MOVE_SHUTTLE.sts);//小车移动到目标库位中 309.小车迁出提升机完成 ==> 310.小车移动中
|
wrkMast.setLiftNo(null);//释放提升机
|
wrkMast.setSystemMsg("");//清空消息
|
wrkMast.setModiTime(now);
|
if (wrkMastService.updateById(wrkMast)) {
|
//下发任务
|
shuttleAction.assignWork(shuttleProtocol.getShuttleNo(), assignCommand);
|
}
|
}
|
return true;
|
}
|
|
//自动切换出入库模式
|
public void autoSwitchForkLiftIOMode() {
|
// List<DeviceConfig> forkliftList = deviceConfigService.selectList(new EntityWrapper<DeviceConfig>()
|
// .eq("device_type", String.valueOf(SlaveType.ForkLift)));
|
// for (DeviceConfig device : forkliftList) {
|
// Integer liftNo = device.getDeviceNo();
|
// ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, liftNo);
|
// if (forkLiftThread == null) {
|
// continue;
|
// }
|
// ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
// if (forkLiftProtocol == null) {
|
// continue;
|
// }
|
//
|
// List<Integer> liftAllStaNo = ForkLiftUtils.getLiftAllStaNo(liftNo);
|
// if (liftAllStaNo.isEmpty()) {
|
// continue;
|
// }
|
//
|
// List<Integer> conveyorBindLiftAllStaNo = ForkLiftUtils.getConveyorBindLiftAllStaNo(liftNo);
|
// if (conveyorBindLiftAllStaNo.isEmpty()) {
|
// continue;
|
// }
|
//
|
// //获取入库任务
|
// List<WrkMast> inWrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
// .in("sta_no", liftAllStaNo)
|
// .in("wrk_sts"
|
// , WrkStsType.NEW_INBOUND.sts
|
// , WrkStsType.INBOUND_DEVICE_RUN.sts
|
// , WrkStsType.INBOUND_LIFT_RUN.sts
|
// , WrkStsType.INBOUND_LIFT_RUN_COMPLETE.sts
|
// , WrkStsType.INBOUND_SHUTTLE_RUN.sts
|
// , WrkStsType.INBOUND_SHUTTLE_RUN_COMPLETE.sts
|
// ));
|
//
|
// //获取出库任务
|
// List<WrkMast> outWrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
// .in("sta_no", conveyorBindLiftAllStaNo)
|
// .in("wrk_sts"
|
// , WrkStsType.NEW_OUTBOUND.sts
|
// , WrkStsType.OUTBOUND_SHUTTLE_RUN.sts
|
// , WrkStsType.OUTBOUND_SHUTTLE_RUN_COMPLETE.sts
|
// , WrkStsType.OUTBOUND_LIFT_RUN.sts
|
// , WrkStsType.OUTBOUND_LIFT_RUN_COMPLETE.sts
|
// ));
|
//
|
// if (forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.NONE)) {
|
// //未知模式
|
// if (!inWrkMasts.isEmpty()) {
|
// forkLiftThread.switchIOMode(ForkLiftIoModeType.IN);
|
// } else if (!outWrkMasts.isEmpty()) {
|
// forkLiftThread.switchIOMode(ForkLiftIoModeType.OUT);
|
// }else {
|
// forkLiftThread.switchIOMode(ForkLiftIoModeType.IN);
|
// }
|
// } else if (forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.IN)) {
|
// //入库模式
|
// if (inWrkMasts.isEmpty() && !outWrkMasts.isEmpty()) {
|
// forkLiftThread.switchIOMode(ForkLiftIoModeType.OUT);
|
// }
|
// } else if (forkLiftProtocol.getIOModeType().equals(ForkLiftIoModeType.OUT)) {
|
// //出库模式
|
// if (outWrkMasts.isEmpty() && !inWrkMasts.isEmpty()) {
|
// forkLiftThread.switchIOMode(ForkLiftIoModeType.IN);
|
// }
|
// }
|
// }
|
}
|
|
//出库任务预调度提升机
|
public void outTaskPreviewDispatchForkLift() {
|
List<WrkMast> wrkMasts = wrkMastService.selectList(new EntityWrapper<WrkMast>()
|
.in("wrk_sts"
|
, WrkStsType.OUTBOUND_SHUTTLE_RUN_COMPLETE.sts
|
));
|
for (WrkMast wrkMast : wrkMasts) {
|
if(wrkMast.getShuttleNo() == null){
|
continue;
|
}
|
|
//获取四向穿梭车线程
|
ShuttleThread shuttleThread = (ShuttleThread) SlaveConnection.get(SlaveType.Shuttle, wrkMast.getShuttleNo());
|
if (shuttleThread == null) {
|
continue;
|
}
|
|
ShuttleProtocol shuttleProtocol = shuttleThread.getStatus();
|
if (shuttleProtocol == null) {
|
continue;
|
}
|
|
if(shuttleProtocol.getCurrentLocNo() == null){
|
continue;
|
}
|
|
//通过输送线站号获取提升机号
|
Integer liftNo = ForkLiftUtils.getConveyorBindLiftNo(wrkMast.getStaNo());
|
if (liftNo == null) {
|
News.taskInfo(wrkMast.getWrkNo(), "{}任务，未找到匹配的提升机", wrkMast.getWrkNo());
|
continue;
|
}
|
|
ForkLiftThread forkLiftThread = (ForkLiftThread) SlaveConnection.get(SlaveType.ForkLift, liftNo);
|
if (forkLiftThread == null) {
|
continue;
|
}
|
|
ForkLiftProtocol forkLiftProtocol = forkLiftThread.getStatus();
|
if (forkLiftProtocol == null) {
|
continue;
|
}
|
|
//存在调度锁
|
Object object = redisUtil.get(RedisKeyType.OUT_TASK_PREVIEW_DISPATCH_FORKLIFT.key + forkLiftProtocol.getLiftNo());
|
if (object != null) {
|
continue;
|
}
|
|
//申请提升机资源
|
boolean applyForkLift = forkLiftAction.applyForkLift(liftNo, null);
|
if(!applyForkLift) {
|
continue;//提升机已被绑定，不再执行预调度任务
|
}
|
|
if (!forkLiftThread.isIdle()) {
|
continue;
|
}
|
|
//提升机不在出库层
|
if (forkLiftProtocol.getLev().equals(Utils.getLev(wrkMast.getSourceLocNo()))) {
|
continue;
|
}
|
|
//移动
|
int workNo = commonService.getWorkNo(WrkIoType.PREVIEW_LIFT_MOVE.id);//获取任务号
|
|
//获取提升机命令
|
ForkLiftCommand liftCommand = forkLiftThread.getMoveCommand(workNo, forkLiftProtocol.getLev(), Utils.getLev(wrkMast.getSourceLocNo()));
|
ArrayList<ForkLiftCommand> commands = new ArrayList<>();
|
commands.add(liftCommand);
|
|
//提交到线程去工作
|
ForkLiftAssignCommand assignCommand = new ForkLiftAssignCommand();
|
assignCommand.setCommands(commands);
|
assignCommand.setLiftNo(forkLiftProtocol.getLiftNo());
|
assignCommand.setTaskNo(workNo);
|
assignCommand.setTaskMode(ForkLiftTaskModeType.MOVE.id);
|
|
forkLiftAction.assignWork(forkLiftProtocol.getLiftNo(), assignCommand);
|
|
redisUtil.set(RedisKeyType.OUT_TASK_PREVIEW_DISPATCH_FORKLIFT.key + forkLiftProtocol.getLiftNo(), "lock", 30);//30秒不再调度
|
}
|
}
|
|
}
|
