Skip to content
Closed
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
29 commits
Select commit Hold shift + click to select a range
c9d3f89
添加传感器数据采集模块
Dec 18, 2025
0d5b42a
模块化PID控制优化
0023csw Dec 18, 2025
9f0723c
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 18, 2025
737c4bd
增加传感器数据采集模型及运行效果
Dec 18, 2025
8728dc7
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 18, 2025
c15f438
修改readme文件
Dec 18, 2025
34dd8d3
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
10fb819
添加LiDAR-IMU紧耦合里程计模块
Dec 19, 2025
837902a
简洁化与环境管理优化
0023csw Dec 19, 2025
a091bb1
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
170d62e
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
9027bb5
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
a92adb9
更新readme文件
Dec 19, 2025
4ced0d4
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
3b3f9b8
添加因子图优化后端模块代码
Dec 19, 2025
7dfbfea
PID控制器再度提升清晰度优化
0023csw Dec 19, 2025
90502cf
Merge branch 'main' into main
0023csw Dec 19, 2025
1326c3e
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
3ac7328
更新README文件
Dec 19, 2025
ae3ff1e
FadingText透明度计算优化
0023csw Dec 19, 2025
0cd6a4c
添加新的检测模块
abc123335 Dec 19, 2025
3269feb
Merge branch 'main' of https://github.com/abc123335/nn
abc123335 Dec 19, 2025
ce54974
Merge pull request #3955 from 0023csw/main
William4861 Dec 19, 2025
aa9599b
Merge pull request #3959 from abc123335/main
William4861 Dec 19, 2025
f5f36d5
Merge pull request #3949 from pppzzz222/main
Arrebol01 Dec 19, 2025
0046b47
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 19, 2025
33026f6
增加全局定位模块
Dec 19, 2025
8040da9
Merge branch 'OpenHUTB:main' into main
pppzzz222 Dec 20, 2025
c45abac
删除多余文件
Dec 20, 2025
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
51 changes: 44 additions & 7 deletions src/Object_Tracking_Planning/object_detection.py
Original file line number Diff line number Diff line change
Expand Up @@ -463,33 +463,70 @@ def render(self, display):


class FadingText(object):
""" Class for fading text """
"""Class for fading text"""

# 常量定义
ALPHA_MULTIPLIER = 500.0 # 透明度计算系数
TEXT_OFFSET = (10, 11) # 文本偏移量
DEFAULT_COLOR = (255, 255, 255) # 默认文本颜色
DEFAULT_SECONDS = 2.0 # 默认显示时间

def __init__(self, font, dim, pos):
"""Constructor method"""
self.font = font
self.dim = dim
self.pos = pos
self.seconds_left = 0
self._init_surface()

def _init_surface(self):
"""初始化Surface"""
self.surface = pygame.Surface(self.dim)
self._clear_surface()

def _clear_surface(self):
"""清空Surface"""
self.surface.fill((0, 0, 0, 0))

def set_text(self, text, color=(255, 255, 255), seconds=2.0):
def set_text(self, text, color=None, seconds=None):
"""Set fading text"""
# 使用默认值
if color is None:
color = self.DEFAULT_COLOR
if seconds is None:
seconds = self.DEFAULT_SECONDS

# 渲染文本
text_texture = self.font.render(text, True, color)

# 准备Surface
self.surface = pygame.Surface(self.dim)
self.seconds_left = seconds
self.surface.fill((0, 0, 0, 0))
self.surface.blit(text_texture, (10, 11))
self._clear_surface()

# 绘制文本
self.surface.blit(text_texture, self.TEXT_OFFSET)

def tick(self, _, clock):
"""Fading text method for every tick"""
delta_seconds = 1e-3 * clock.get_time()
# 计算经过的时间
delta_seconds = clock.get_time() / 1000.0 # 转换为秒

# 更新时间
self.seconds_left = max(0.0, self.seconds_left - delta_seconds)
self.surface.set_alpha(500.0 * self.seconds_left)

# 更新透明度
self._update_alpha()

def _update_alpha(self):
"""更新Surface的透明度"""
alpha_value = self.seconds_left * self.ALPHA_MULTIPLIER
self.surface.set_alpha(alpha_value)

def render(self, display):
"""Render fading text method"""
display.blit(self.surface, self.pos)
if self.seconds_left > 0:
display.blit(self.surface, self.pos)


# ==============================================================================
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -36,3 +36,9 @@ outdoor_ws/src/robot_description/
- 扫描匹配(ICP)估计相对运动
- 融合IMU、激光雷达和GNSS数据
- 输出高频位姿估计(前端里程计)
3. **全局地图优化与闭环检测**
- 构建因子图优化问题(节点=位姿,因子=约束)
- 融合多种约束:里程计因子、GNSS因子、闭环因子
- 检测回环并消除累积误差
- 子图管理优化大范围建图
- 执行全局优化(类似g2o/GTSAM的功能)
Loading
Loading