--camera left/--camera right 选择),并显示一个可调节 RGB/深度混合轨迹条的混合叠加层。演示

源代码
Python
PythonGitHub
1#!/usr/bin/env python3
2"""Align ToF depth over left or right camera and show a blended overlay.
3
4Usage:
5 python tof_align.py --camera left
6 python tof_align.py --camera right
7"""
8
9import argparse
10from datetime import timedelta
11
12import cv2
13import depthai as dai
14
15
16FPS = 30.0
17CAMERA_SIZE = (640, 400)
18
19MIN_DEPTH = 100.0
20MAX_DEPTH = 7000.0
21
22rgbWeight = 0.5
23depthWeight = 0.5
24
25
26def updateBlendWeights(percentRgb):
27 global rgbWeight, depthWeight
28 rgbWeight = float(percentRgb) / 100.0
29 depthWeight = 1.0 - rgbWeight
30
31
32def main():
33 parser = argparse.ArgumentParser(description="ToF depth overlay on left or right camera")
34 parser.add_argument(
35 "--camera",
36 choices=["left", "right"],
37 default="left",
38 help="Camera to align depth onto: left=CAM_B, right=CAM_C (default: left)",
39 )
40 args = parser.parse_args()
41
42 pipeline = dai.Pipeline()
43
44 camera_sockets = {
45 "left": dai.CameraBoardSocket.CAM_B,
46 "right": dai.CameraBoardSocket.CAM_C,
47 }
48
49 align_socket = camera_sockets[args.camera]
50 print(f"Aligning ToF depth over {args.camera} camera ({align_socket})")
51
52 tof = pipeline.create(dai.node.ToF)
53 tof.build(
54 boardSocket=dai.CameraBoardSocket.AUTO,
55 profile=dai.ToFConfig.Profile.MID_RANGE,
56 fps=FPS,
57 )
58
59 cam = pipeline.create(dai.node.Camera).build(align_socket)
60 camOut = cam.requestOutput(CAMERA_SIZE, enableUndistortion=True, fps=FPS)
61
62 align = pipeline.create(dai.node.ImageAlign)
63 align.setRunOnHost(True)
64 tof.depth.link(align.input)
65 camOut.link(align.inputAlignTo)
66
67 sync = pipeline.create(dai.node.Sync)
68 sync.setSyncThreshold(timedelta(seconds=0.5 / FPS))
69 sync.setRunOnHost(True)
70 camOut.link(sync.inputs["rgb"])
71 align.outputAligned.link(sync.inputs["depth_aligned"])
72 sync.inputs["rgb"].setBlocking(False)
73
74 syncQueue = sync.out.createOutputQueue()
75
76 window_blend = f"tof-overlay-{args.camera}"
77 window_depth = "depth-aligned"
78
79 with pipeline as p:
80 p.start()
81 cv2.namedWindow(window_blend)
82 cv2.namedWindow(window_depth)
83 cv2.createTrackbar("RGB Weight %", window_blend, int(rgbWeight * 100), 100, updateBlendWeights)
84
85 while p.isRunning():
86 msgGroup = syncQueue.get()
87 assert isinstance(msgGroup, dai.MessageGroup)
88
89 frameRgb = msgGroup["rgb"]
90 frameDepth = msgGroup["depth_aligned"]
91
92 cvFrame = frameRgb.getCvFrame()
93 if len(cvFrame.shape) == 2:
94 cvFrame = cv2.cvtColor(cvFrame, cv2.COLOR_GRAY2BGR)
95
96 depthColorized = dai.utility.colorizeDepthFrame(frameDepth, MIN_DEPTH, MAX_DEPTH, useLog=True).getCvFrame()
97 if depthColorized.shape[:2] != cvFrame.shape[:2]:
98 depthColorized = cv2.resize(
99 depthColorized, (cvFrame.shape[1], cvFrame.shape[0])
100 )
101
102 cv2.imshow(window_depth, depthColorized)
103
104 blended = cv2.addWeighted(cvFrame, rgbWeight, depthColorized, depthWeight, 0)
105 cv2.imshow(window_blend, blended)
106
107 if cv2.waitKey(1) == ord("q"):
108 break
109
110
111if __name__ == "__main__":
112 main()需要帮助?
请访问讨论论坛以获取技术支持或您可能有的任何其他问题。