调整
This commit is contained in:
parent
b5d0d09a1e
commit
8400d190d8
@ -110,17 +110,17 @@ def position_callback(msg):
|
||||
res = fft_client(data_x=noisy_x_history[-FFT_WINDOW_SIZE:],
|
||||
data_y=noisy_y_history[-FFT_WINDOW_SIZE:],
|
||||
window_size=FFT_WINDOW_SIZE)
|
||||
rospy.loginfo("FFT computed successfully")
|
||||
rospy.loginfo("FFT计算成功")
|
||||
current_x_magnitudes[:] = res.magnitude_x
|
||||
current_y_magnitudes[:] = res.magnitude_y
|
||||
except rospy.ServiceException as e:
|
||||
rospy.logerr("Failed to call FFT service: %s" % e)
|
||||
rospy.logerr("FFT计算失败: %s" % e)
|
||||
|
||||
# 判断频谱,生成频谱图
|
||||
if current_x_magnitudes and current_y_magnitudes:
|
||||
x_spectrum = Marker()
|
||||
x_spectrum.header = msg.header
|
||||
x_spectrum.ns = "坐标x频谱"
|
||||
x_spectrum.ns = "x_spectrum"
|
||||
x_spectrum.id = 2
|
||||
x_spectrum.type = Marker.CUBE_LIST
|
||||
x_spectrum.action = Marker.ADD
|
||||
@ -132,7 +132,7 @@ def position_callback(msg):
|
||||
|
||||
y_spectrum = Marker()
|
||||
y_spectrum.header = msg.header
|
||||
y_spectrum.ns = "坐标y频谱"
|
||||
y_spectrum.ns = "y_spectrum"
|
||||
y_spectrum.id = 3
|
||||
y_spectrum.type = Marker.CUBE_LIST
|
||||
y_spectrum.action = Marker.ADD
|
||||
|
Loading…
x
Reference in New Issue
Block a user