-
Notifications
You must be signed in to change notification settings - Fork 0
/
alg.js
96 lines (82 loc) · 2.94 KB
/
alg.js
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
// BFS for shortest path
function bfsShortestPath(layout, start, goal) {
const graph = layout.points;
const queue = [[start, [start]]];
const visited = new Set();
while (queue.length > 0) {
const [current, path] = queue.shift();
if (current === goal) {
return path;
}
if (visited.has(current)) {
continue;
}
visited.add(current);
for (const [direction, neighbor] of Object.entries(graph[current])) {
if (direction !== 'x' && direction !== 'y' && !visited.has(neighbor)) {
queue.push([neighbor, path.concat(neighbor)]);
}
}
}
return [];
}
// Calculate commands from path
function calculateCommands(path, layout) {
const commands = [];
const points = layout.points;
for (let i = 0; i < path.length - 1; i++) {
const current = path[i];
const next = path[i + 1];
const currentPoint = points[current];
const nextPoint = points[next];
for (const [direction, neighbor] of Object.entries(currentPoint)) {
if (neighbor === next) {
commands.push({ "command": "move", "direction": direction });
break;
}
}
}
return commands;
}
// Delivery robot algorithm
function schedule(layout, orderList) {
const pickupPoint = layout["pickup-point"];
let currentPosition = pickupPoint;
const drinkCapacity = 5;
let currentDrinks = 0;
const plan = [];
// Convert orderList to an array of orders
const orders = Object.entries(orderList).map(([point, count]) => ({ point, count }));
while (orders.length > 0) {
const ordersToDeliver = [];
const remainingOrders = [];
// Collect up to drink_capacity orders
for (const order of orders) {
if (currentDrinks + order.count <= drinkCapacity) {
ordersToDeliver.push(order);
currentDrinks += order.count;
} else {
remainingOrders.push(order);
}
}
// Go to pickup point
const pathToPickup = bfsShortestPath(layout, currentPosition, pickupPoint);
plan.push(...calculateCommands(pathToPickup, layout));
plan.push({ "command": "pickUp", "count": currentDrinks });
currentPosition = pickupPoint;
// Deliver all collected orders
for (const order of ordersToDeliver) {
const destination = order.point;
const pathToDelivery = bfsShortestPath(layout, currentPosition, destination);
plan.push(...calculateCommands(pathToDelivery, layout));
plan.push({ "command": "deliver", "count": order.count });
currentPosition = destination;
}
// Reset currentDrinks and update orders
currentDrinks = 0;
orders.length = 0;
orders.push(...remainingOrders);
}
return plan;
}
module.exports = { schedule };