yuliang
/
yvan-rcs-web
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity
Browse Source

cl2 基于设备状态和任务状态分步生成设备任务消息

master
yuliang 6 months ago
parent
3bb9ab09a1
commit
9bbea8b9b4
2 changed files with 526 additions and 36 deletions
Whitespace
Show all changes Ignore whitespace when comparing lines Ignore changes in amount of whitespace Ignore changes in whitespace at EOL
Unified View
Diff Options
Show Stats Download Patch File Download Diff File
  1. 422
      doc/command-example/f1.json
  2. 94
      src/modules/cl2/Cl23dObject.ts

422
doc/command-example/f1.json
View File

@ -0,0 +1,422 @@
[
{
"id": "rack1",
"t": "rack",
"v": true,
"tf": [
[
1.55,
0,
-1.5
],
[
0,
0,
0
],
[
2.2,
2.8,
1
]
],
"dt": {
"rackDepth": 1,
"bottomBarHeight": 0.2,
"bottomLinkHeight": 0.2,
"topLinkDistance": 0.2,
"levelCount": 2,
"bayCount": 2,
"hideFloor": 0,
"extendColumns": 1,
"columnSpacing": 1,
"bays": [
{
"bayWidth": 1.1,
"levelHeight": [
1.4,
1.4
]
},
{
"bayWidth": 1.1,
"levelHeight": [
1.4,
1.4
]
}
],
"center": [],
"in": [],
"out": [],
"rackWidth": 2.2,
"rackHeight": 2.8
},
"_rid": "_2"
},
{
"id": "rack2",
"t": "rack",
"v": true,
"tf": [
[
3.9,
0,
-1.5
],
[
0,
0,
0
],
[
2.2,
2.8,
1
]
],
"dt": {
"rackDepth": 1,
"bottomBarHeight": 0.2,
"bottomLinkHeight": 0.2,
"topLinkDistance": 0.2,
"levelCount": 2,
"bayCount": 2,
"hideFloor": 0,
"extendColumns": 1,
"columnSpacing": 1,
"bays": [
{
"bayWidth": 1.1,
"levelHeight": [
1.4,
1.4
]
},
{
"bayWidth": 1.1,
"levelHeight": [
1.4,
1.4
]
}
],
"center": [],
"in": [],
"out": [],
"rackWidth": 2.2,
"rackHeight": 2.8
},
"_rid": "_3"
},
{
"id": "1_2",
"t": "way",
"v": true,
"logicX": 1,
"logicY": 2,
"tf": [
[
1,
0.01,
0
],
[
0,
0,
0
],
[
0.25,
0.1,
0.25
]
],
"dt": {
"in": [
"2_2"
],
"out": [
"2_2"
],
"center": [],
"linkStore": [
{
"item": "rack1",
"bay": 0,
"level": 0,
"cell": 0,
"direction": "up"
},
{
"item": "rack1",
"bay": 0,
"level": 1,
"cell": 0,
"direction": "up"
}
]
},
"_rid": "_4"
},
{
"id": "2_2",
"t": "way",
"v": true,
"logicX": 2,
"logicY": 2,
"tf": [
[
2.1,
0.01,
0
],
[
0,
0,
0
],
[
0.25,
0.1,
0.25
]
],
"dt": {
"in": [
"1_2",
"3_2"
],
"out": [
"1_2",
"3_2"
],
"center": [],
"linkStore": [
{
"item": "rack1",
"bay": 1,
"level": 0,
"cell": 0,
"direction": "up"
},
{
"item": "rack1",
"bay": 1,
"level": 1,
"cell": 0,
"direction": "up"
}
]
},
"_rid": "_5"
},
{
"id": "3_2",
"t": "way",
"v": true,
"logicX": 3,
"logicY": 2,
"tf": [
[
3.39,
0.01,
0
],
[
0,
0,
0
],
[
0.25,
0.1,
0.25
]
],
"dt": {
"in": [
"2_2",
"4_2"
],
"out": [
"2_2",
"4_2"
],
"center": [],
"linkStore": [
{
"item": "rack2",
"bay": 0,
"level": 0,
"cell": 0,
"direction": "up"
},
{
"item": "rack2",
"bay": 0,
"level": 1,
"cell": 0,
"direction": "up"
}
]
},
"_rid": "_6"
},
{
"id": "4_2",
"t": "way",
"v": true,
"logicX": 4,
"logicY": 2,
"tf": [
[
4.44,
0.01,
0
],
[
0,
0,
0
],
[
0.25,
0.1,
0.25
]
],
"dt": {
"in": [
"3_2",
"5_2"
],
"out": [
"3_2",
"5_2"
],
"center": [],
"linkStore": [
{
"item": "rack2",
"bay": 1,
"level": 0,
"cell": 0,
"direction": "up"
},
{
"item": "rack2",
"bay": 1,
"level": 1,
"cell": 0,
"direction": "up"
}
]
},
"_rid": "_7"
},
{
"id": "5_2",
"t": "way",
"v": true,
"logicX": 5,
"logicY": 2,
"tf": [
[
5.44,
0.01,
0
],
[
0,
0,
0
],
[
0.25,
0.1,
0.25
]
],
"dt": {
"in": [
"4_2",
"6_2"
],
"out": [
"4_2",
"6_2"
],
"center": []
},
"_rid": "_8"
},
{
"id": "6_2",
"t": "way",
"v": true,
"logicX": 6,
"logicY": 2,
"tf": [
[
6.44,
0.01,
0
],
[
0,
0,
0
],
[
0.25,
0.1,
0.25
]
],
"dt": {
"in": [
"5_2"
],
"out": [
"5_2"
],
"center": [],
"agvRotation": [
"cl2",
"clx"
]
},
"_rid": "_9"
},
{
"id": "3",
"t": "cl2",
"v": true,
"tf": [
[
6.440,
0,
0
],
[
0,
0,
0
],
[
1.5,
1.98,
1.5
]
],
"dt": {
"in": [],
"out": [],
"center": [],
"ptrWidth": 1.5,
"ptrDepth": 1.5,
"ptrHeight": 1.98
}
}
]

94
src/modules/cl2/Cl23dObject.ts
View File

@ -25,7 +25,7 @@ export interface Cl2Task {
GoodsSlotDirection: 0 | 1 | 2 | 3 | 15; GoodsSlotDirection: 0 | 1 | 2 | 3 | 15;
GoodsId: string; GoodsId: string;
Link: { Link: {
id: string; // 实际报文没有 // id: string; // 实际报文没有
X: number; X: number;
Y: number; Y: number;
Speed: number; Speed: number;
@ -170,7 +170,6 @@ export default class Cl23dObject extends THREE.Object3D {
let geometry = new THREE.ExtrudeGeometry(shape, options) let geometry = new THREE.ExtrudeGeometry(shape, options)
const fd = 0.03 const fd = 0.03
const shapeBf = new THREE.Shape(); const shapeBf = new THREE.Shape();
@ -345,7 +344,8 @@ export default class Cl23dObject extends THREE.Object3D {
private rotationAnimation: core.Tween = null; private rotationAnimation: core.Tween = null;
private riseAnimation: core.Tween = null; private riseAnimation: core.Tween = null;
private stretchAnimation: core.Tween = null; private stretchAnimation: core.Tween = null;
private currentAnimation: core.Tween = null;
private currentDirection: number = 15;
public get cl2Entity(): Cl2Entity { public get cl2Entity(): Cl2Entity {
@ -357,6 +357,7 @@ export default class Cl23dObject extends THREE.Object3D {
} }
private clock = new THREE.Clock(); private clock = new THREE.Clock();
constructor(item: ItemJson, option?: RendererCudOption) { constructor(item: ItemJson, option?: RendererCudOption) {
super(); super();
console.log("time", this.clock.getElapsedTime()); console.log("time", this.clock.getElapsedTime());
@ -461,19 +462,54 @@ export default class Cl23dObject extends THREE.Object3D {
} }
} }
const startTask = {
X: data.content.StartX,
Y: data.content.StartY,
Speed: 0
}
for (const item of data.content.Link) { for (const item of data.content.Link) {
let moveDirection: 0 | 1 | 2 | 3 | 15 = 15;
if (startTask.X < item.X) {
if (item.Speed > 0) {
moveDirection = 0
} else {
moveDirection = 2
}
}
if (startTask.Y < item.Y) {
if (item.Speed > 0) {
moveDirection = 1
} else {
moveDirection = 3
}
}
// 添加到队列 // 添加到队列
this.taskList.push({ this.taskList.push({
SeqNo: data.content.SeqNo, SeqNo: data.content.SeqNo,
OperationType: data.content.OperationType, OperationType: 0,
PickMode: data.content.PickMode, PickMode: 0,
GoodsSlotHeight: data.content.GoodsSlotHeight, GoodsSlotHeight: data.content.GoodsSlotHeight,
GoodsSlotDirection: data.content.GoodsSlotDirection, GoodsSlotDirection: data.content.GoodsSlotDirection,
X: item.X, X: item.X,
Y: item.Y, Y: item.Y,
Speed: item.Speed, Speed: item.Speed,
Direction: moveDirection
})
startTask.X = item.X
startTask.Y = item.Y
startTask.Speed = item.Speed
}
if (data.content.OperationType === 4 || data.content.OperationType === 5) {
this.taskList.push({
OperationType: data.content.OperationType,
PickMode: data.content.PickMode,
GoodsSlotHeight: data.content.GoodsSlotHeight,
GoodsSlotDirection: data.content.GoodsSlotDirection,
}) })
} }
console.log("time", this.clock.getElapsedTime()); console.log("time", this.clock.getElapsedTime());
this.executeTask() this.executeTask()
@ -488,11 +524,16 @@ export default class Cl23dObject extends THREE.Object3D {
executeTask() { executeTask() {
const currentTask = this.executingTask[this.executingTask.length - 1]
while (this.taskList.length > 0) { while (this.taskList.length > 0) {
const task = this.taskList.shift() const task = this.taskList.shift()
if (task.OperationType === 0) {
this.addTravel(task.X, task.Y, task.Speed / 1000) this.addTravel(task.X, task.Y, task.Speed / 1000)
}
this.executingTask.push(task) if ((task.Speed > 0) != (currentTask.Speed > 1) || task.Direction != currentTask.Direction) {
// 转向
// this.addArmRotate(task.Direction)
}
} }
@ -561,24 +602,49 @@ export default class Cl23dObject extends THREE.Object3D {
// 转 // 转
addRotation(rad: number): Promise<void> { addRotation(direction: number): Promise<void> {
let rad = 0;
switch (direction) {
case 1:
rad = Math.PI / 2 * 3;
break;
case 2:
rad = Math.PI;
break;
case 3:
rad = Math.PI / 2;
break;
default:
rad = 0;
}
const quat1 = new THREE.Quaternion().setFromEuler(this.rotation); const quat1 = new THREE.Quaternion().setFromEuler(this.rotation);
const euler: Euler = new Euler(this.rotation.x, rad, this.rotation.z); const euler: Euler = new Euler(this.rotation.x, rad, this.rotation.z);
const quat2 = new THREE.Quaternion().setFromEuler(euler); const quat2 = new THREE.Quaternion().setFromEuler(euler);
const angleDiff = quat1.angleTo(quat2); const angleDiff = quat1.angleTo(quat2);
console.log(rad, this.rotation.y, angleDiff) console.log(rad, this.rotation.y, angleDiff)
const tr = this.rotation.y + angleDiff const tr = this.rotation.y + angleDiff
let time = Math.abs(angleDiff) / (Math.PI/3) let time = Math.abs(angleDiff) / (Math.PI / 7)
const duration = angleDiff != 0 ? Math.max(0.5, time) : 0 const duration = time
if (!this.rotationAnimation) {
return new Promise(resolve => { return new Promise(resolve => {
gsap.to(this.rotation, { this.rotationAnimation = gsap.to(this.rotation, {
y: tr, y: tr,
duration, duration,
ease: 'none', ease: 'none',
onComplete: resolve onComplete: () => {
this.rotationAnimation = null
this.currentAnimation = null
resolve()
}
}) })
this.currentAnimation = this.rotationAnimation
}) })
} else {
this.rotationAnimation.vars.y = tr
const tt = this.rotationAnimation.duration()
this.rotationAnimation.duration(tt + duration)
}
} }
// 走 // 走
@ -601,9 +667,11 @@ export default class Cl23dObject extends THREE.Object3D {
ease: 'sine.inOut', ease: 'sine.inOut',
onComplete: () => { onComplete: () => {
this.travelAnimation = null; this.travelAnimation = null;
this.currentAnimation = null
resolve() resolve()
} }
}) })
this.currentAnimation = this.travelAnimation
}) })
} else { } else {
this.travelAnimation.vars.x = toPos.x this.travelAnimation.vars.x = toPos.x

Write Preview
Loading…
Cancel
Save