liusuyi
2025-02-20 ab55c60112c72fcfe7836a91a278f316cddd7c00
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
package com.ard.tianyu.service.impl;
 
import com.alibaba.fastjson2.JSON;
import com.ard.common.exception.NoPermissionException;
import com.ard.common.utils.SecurityUtils;
import com.ard.tianyu.websocket.domain.ControlMessage;
import com.ard.tianyu.websocket.domain.WsMessage;
import com.ard.tianyu.websocket.utils.WebSocketUtil;
import lombok.extern.slf4j.Slf4j;
import org.springframework.stereotype.Service;
 
import java.util.concurrent.ConcurrentHashMap;
 
@Service
@Slf4j
public class UavControlManager {
 
    // 存储每个无人机的当前控制者
    public static final ConcurrentHashMap<String, Long> droneControlMap = new ConcurrentHashMap<>();
 
    // 存储无人机的控制请求(用于判断哪个控制者正在等待)
    public static final ConcurrentHashMap<String, Long> controlRequestMap = new ConcurrentHashMap<>();
 
    // 发送通知(通过 WebSocket推送)
    public void notifyMessage(String boxSn, String action, Long source, Long target) {
        ControlMessage controlMessage = ControlMessage.builder()
                .boxSn(boxSn)
                .userId(source)
                .action(action)
                .build();
        WsMessage<ControlMessage> wsMessage = new WsMessage<>("controlRequest", controlMessage);
        WebSocketUtil.sendMessage(target.toString(), JSON.toJSONString(wsMessage));
    }
 
    // 申请控制
    public boolean requestControl(String boxSn) {
        Long requester = SecurityUtils.getUserId();
        // 如果无人机没有控制者,直接控制
        if (droneControlMap.get(boxSn) == null) {
            droneControlMap.put(boxSn, requester);
            return true; // 控制成功
        }
        // 如果无人机已经有控制者,则发送申请给当前控制者
        Long controller = droneControlMap.get(boxSn);
        if (!controller.equals(requester)) {
            // 则将控制请求加入请求队列
            controlRequestMap.put(boxSn, requester);
            // 通知当前控制者,有新的控制请求
            notifyMessage(boxSn, "request", requester, controller);
        } else {
            throw new NoPermissionException("当前已经获取控制权,无需重复申请");
        }
        return false; // 等待当前控制者的同意
    }
 
    // 处理控制请求的同意或拒绝
    public boolean handleControlResponse(String boxSn, boolean approve) {
        Long controller = SecurityUtils.getUserId();
        Long requester = controlRequestMap.get(boxSn);
        // 确保请求者是当前的控制者
        if (requester != null && !requester.equals(controller)) {
            if (approve) {
                // 同意控制,将控制权赋予请求者
                droneControlMap.put(boxSn, requester);
                notifyMessage(boxSn, "approve", controller, requester);
            } else {
                notifyMessage(boxSn, "reject", controller, requester);
            }
            // 无论同意还是拒绝,都移除控制请求
            controlRequestMap.remove(boxSn);
            return true;
        }
        else {
            throw new NoPermissionException("无申请不需要处理控制权");
        }
    }
 
    // 释放控制
    public boolean releaseControl(String boxSn) {
        Long controller = droneControlMap.get(boxSn);
        if (controller != null) {
            if (controller.equals(SecurityUtils.getUserId())) {
                droneControlMap.remove(boxSn);
                return true;
            } else {
                // 当前控制者不匹配,可以记录日志或者抛出异常
                log.warn("无权限释放控制, 实际控制者是 {}", controller);
                throw new NoPermissionException("无权限释放控制, 实际控制者是 " + controller);
            }
        } else {
            // 说明无人机没有控制者
            log.warn("无人机当前 {} 没有控制者,无需释放", boxSn);
            throw new NoPermissionException("无人机" + boxSn + "当前没有控制者,无需释放");
        }
    }
}