|
|
@ -332,10 +332,10 @@ def main():
|
|
|
|
T = 500.0 # 最大模拟时间
|
|
|
|
T = 500.0 # 最大模拟时间
|
|
|
|
# 设置车辆的出事状态
|
|
|
|
# 设置车辆的出事状态
|
|
|
|
yaw=math.radians(450-(347+180-360))
|
|
|
|
yaw=math.radians(450-(347+180-360))
|
|
|
|
x_car = np.cos(yaw) * 2.3 + float(100)
|
|
|
|
x_car = np.cos(yaw) * 2.3 + float(96)
|
|
|
|
# print('x',x_car)
|
|
|
|
# print('x',x_car)
|
|
|
|
# north = beidou[15] # 北向位置坐标:以基站为原点的地理坐标系下的北向位置,单位:米,小数点后 3 位
|
|
|
|
# north = beidou[15] # 北向位置坐标:以基站为原点的地理坐标系下的北向位置,单位:米,小数点后 3 位
|
|
|
|
y_car = -np.sin(yaw) * 2.3 + float(-9.78)
|
|
|
|
y_car = -np.sin(yaw) * 2.3 + float(9.9)
|
|
|
|
|
|
|
|
|
|
|
|
# print('yaw_1',yaw)
|
|
|
|
# print('yaw_1',yaw)
|
|
|
|
|
|
|
|
|
|
|
|