Skip to content
Merged
Show file tree
Hide file tree
Changes from all commits
Commits
Show all changes
24 commits
Select commit Hold shift + click to select a range
26fe721
添加“main_mpc_controller.py”文件,并调优求解器参数
Liufu27 Dec 18, 2025
f30e281
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 19, 2025
ae0c38b
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 19, 2025
eb6b692
更新README.md文件
Liufu27 Dec 19, 2025
f1bc40e
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 19, 2025
73ee61e
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 19, 2025
d258d15
在MPC控制器文件中添加热启动补充
Liufu27 Dec 19, 2025
2b2c422
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 19, 2025
024875e
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 19, 2025
d87e610
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 20, 2025
d6edc67
提交Carla交互文件,并且添加感知规划相关的绘制方法
Liufu27 Dec 20, 2025
8866796
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 20, 2025
561e2df
添加配置文件,并修改,并且更新main
Liufu27 Dec 20, 2025
af3376a
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
09e6d80
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
9ba4a48
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
a3ff118
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
e79b3c9
注释掉原来的线性轨迹和空旷场景,换为道路场景
Liufu27 Dec 22, 2025
b151c2c
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
b1a626c
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
6d84eae
在道路上添加障碍物
Liufu27 Dec 22, 2025
b23b1c2
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
b87740e
Merge branch 'OpenHUTB:main' into main
Liufu27 Dec 22, 2025
3e1e921
添加一定的避障功能
Liufu27 Dec 22, 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
66 changes: 65 additions & 1 deletion src/Unmanned_vehicle_control/config.py
Original file line number Diff line number Diff line change
@@ -1,5 +1,68 @@
import numpy as np

X_INIT_M = 210
Y_INIT_M = 362
A = 25
LAPS = 1

MAX_ACCELERATION_M_S_2 = 10
MAX_BRAKING_M_S_2 = -4.1
MAX_WHEEL_ANGLE_RAD = 70 / 180 * np.pi
L = 2.875

### MPC settings
N = 5
dt = 0.1
MAX_CONTROL_WHEEL_ANGLE_RAD = 70 / 180 * np.pi
MAX_CONTROL_ACCELERATION_M_S_2 = 10
MAX_CONTROL_BRAKING_M_S_2 = -4.1
PATH_TOLERANCE_M = 0.5
V_REF = 5

"""
原始代码被注释掉:
FINE_X_COEF = 10
FINE_Y_COEF = 10
FINE_STEER_COEF = 0
FINE_ACC_COEF = 0
FINE_STEER_DOT_COEF = 100
FINE_ACC_DOT_COEF = 1
FINE_V_COEF = 20
FINE_THETA_COEF = 0
FINE_LATERAL_COEF = 40
"""

FINE_X_COEF = 10
FINE_Y_COEF = 10
FINE_STEER_COEF = 0
FINE_ACC_COEF = 0
FINE_STEER_DOT_COEF = 100
FINE_ACC_DOT_COEF = 1
FINE_V_COEF = 20
FINE_THETA_COEF = 0
FINE_LATERAL_COEF = 40

# 避障相关参数
OBSTACLE_PENALTY_WEIGHT = 100.0
OBSTACLE_SAFETY_DISTANCE = 3.0
OBSTACLE_AVOIDANCE_ENABLED = True

# 圆形轨迹参数
CIRCLE_CENTER_X = X_INIT_M
CIRCLE_CENTER_Y = Y_INIT_M
CIRCLE_RADIUS = 50

VISUALIZATION_CONFIG = {
'show_full_trajectory': False,
'show_perception_planning': True,
'show_frenet_frame': False,
'look_ahead_points': N,
'target_point_color': (255, 0, 0),
'trajectory_color': (0, 255, 0),
'obstacle_color': (255, 0, 0),
'safety_zone_color': (255, 165, 0),
}
"""
X_INIT_M = 210 # Start X coordinate for vehicle
Y_INIT_M = 362 # Start Y coordinate for vehicle
A = 25 # Size of 8-trajectory
Expand Down Expand Up @@ -41,4 +104,5 @@
'look_ahead_points': N, # 向前看的点数
'target_point_color': (255, 0, 0), # 目标点颜色 (R, G, B)
'trajectory_color': (0, 255, 0), # 轨迹线颜色
}
}
"""
Loading
Loading