首先,我们以雷达为坐标系远点,在其前方200米设置一辆车,车宽3.74米(假设是个大翻斗子)。
则:
wide = [-1.87, 1.87]
y = 200
设置雷达扫描频率,以1°为步长进行扫描:
hz = 1
设置雷达起始位置
alpha = 45
扫描过程如下:
for i in range((180-alpha)*hz):
#print(np.tan((i/hz) / 180 * np.pi))
x = y / np.tan((i/hz) / 180 * np.pi)
if x < wide[1] and x > wide[0]:
count += 1
完整代码如下:
import numpy as np
alpha = 45
hz = 1
y = 200
wide = [-1.87, 1.87]
count = 1
for i in range((180-alpha)*hz):
#print(np.tan((i/hz) / 180 * np.pi))
x = y / np.tan((i/hz) / 180 * np.pi)
if x < wide[1] and x > wide[0]:
count += 1
print(count)
版权声明:本文为weixin_44843629原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接和本声明。