-
Notifications
You must be signed in to change notification settings - Fork 0
/
radardata.py
166 lines (130 loc) · 6.25 KB
/
radardata.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
#!/usr/bin/env python
from __future__ import print_function, division
import sys
from argparse import ArgumentParser
import time
import numpy as np
import matplotlib.pyplot as plt
import matplotlib.animation as animation
import pymoduleconnector
from pymoduleconnector import ModuleConnector
from pymoduleconnector import DataType
from pymoduleconnector import DataRecorder
from pymoduleconnector import DataPlayer
from pymoduleconnector import RecordingOptions
from pymoduleconnector.extras.auto import auto
from pymoduleconnector.ids import *
#from xt_modules_print_info import print_module_info
from xt_modules_print_info import print_sensor_settings
from xt_modules_record_playback_messages import start_recorder
from xt_modules_record_playback_messages import start_player
import serial
import serial.tools.list_ports
respiration_sensor_state_text = (
"BREATHING", "MOVEMENT", "MOVEMENT_TRACKING", "NO_MOVEMENT", "INITIALIZING")
# User settings introduction
x4m200_par_settings = {'detection_zone': (0.5, 2),
'sensitivity': 1,
'tx_center_frequency': 3, # 3: TX 7.29GHz low band center frequency, 4: TX 8.748GHz low band center frequency.
'led_control': (XTID_LED_MODE_FULL, 0),
# initialize noisemap everytime when get start (approximately 120s)
'noisemap_control': 0b000,
# only uncomment the message when you need them to avoide confliction.
# 'output_control1': (XTS_ID_BASEBAND_IQ, 0),
# 'output_control2': (XTS_ID_BASEBAND_AMPLITUDE_PHASE, 0),
# 'output_control3': (XTS_ID_PULSEDOPPLER_FLOAT, 0),
# 'output_control4': (XTS_ID_PULSEDOPPLER_BYTE, 0),
# 'output_control5': (XTS_ID_NOISEMAP_FLOAT, 0),
# 'output_control6': (XTS_ID_NOISEMAP_BYTE, 0),
'output_control7': (XTS_ID_SLEEP_STATUS, 1),
# 'output_control8': (XTS_ID_RESP_STATUS, 1),
# 'output_control9': (XTS_ID_VITAL_SIGNS, 0),
'output_control10': (XTS_ID_RESPIRATION_MOVINGLIST, 1),
# 'output_control11': (XTS_ID_RESPIRATION_DETECTIONLIST, 0)
}
def configure_x4m200(device_name, record=False, x4m200_settings=x4m200_par_settings):
mc = ModuleConnector(device_name)
x4m200 = mc.get_x4m200()
print('Clearing buffer')
while x4m200.peek_message_baseband_iq():
x4m200.read_message_baseband_iq()
while x4m200.peek_message_baseband_ap():
x4m200.read_message_baseband_ap()
while x4m200.peek_message_respiration_legacy():
x4m200.read_message_respiration_legacy()
while x4m200.peek_message_respiration_sleep():
x4m200.read_message_respiration_sleep()
while x4m200.peek_message_respiration_movinglist():
x4m200.read_message_respiration_movinglist()
while x4m200.peek_message_pulsedoppler_byte():
x4m200.read_message_pulsedoppler_byte()
while x4m200.peek_message_pulsedoppler_float():
x4m200.read_message_pulsedoppler_float()
while x4m200.peek_message_noisemap_byte():
x4m200.read_message_noisemap_byte()
while x4m200.peek_message_noisemap_float():
x4m200.read_message_noisemap_float()
print('Start recorder if recording is enabled')
if record:
start_recorder(mc)
print('Ensuring no Xethru profile running')
try:
x4m200.set_sensor_mode(XTID_SM_STOP, 0)
except RuntimeError:
print('Xethru module could not enter stop mode')
print('Loading new Xethru profile')
x4m200.load_profile(XTS_ID_APP_RESPIRATION_2)
print('Set parameters')
for variable, value in x4m200_settings.items():
try:
if 'output_control' in variable:
variable = 'output_control'
setter_set = getattr(x4m200, 'set_' + variable)
except AttributeError as e:
print("X4M200 does not have a setter function for '%s'." % variable)
raise e
if isinstance(value, tuple):
setter_set(*value)
else:
setter_set(value)
print("Setting %s to %s" % (variable, value))
print_sensor_settings(x4m200)
print('Set module to RUN mode')
try:
x4m200.set_sensor_mode(XTID_SM_RUN, 0) # RUN mode
except RuntimeError:
print('Xethru module cloud not enter run mode')
return x4m200
def print_x4m200_messages(x4m200):
try:
ctr = True
while ctr == True:
while x4m200.peek_message_respiration_legacy(): # update every 1/17 second
rdata = x4m200.read_message_respiration_legacy()
""" print(rdata.sensor_state)
x4m200 = configure_x4m200(
'/dev/ttyACM0', False, x4m200_par_settings)
#return("frame_counter: {} sensor_state: {} respiration_rate: {} distance: {} Breath Pattern: {} signal_quality: {}" .format(rdata.frame_counter, rdata.sensor_state, rdata.respiration_rate, rdata.distance, rdata.movement, rdata.signal_quality))
rdata = x4m200.read_message_respiration_legacy() """
return("respiration_rate: {} Breath_Pattern: {} Sensor_State: {}" .format(rdata.respiration_rate, rdata.movement, respiration_sensor_state_text[rdata.sensor_state]))
""" while x4m200.peek_message_respiration_sleep(): # update every 1 second
rdata = x4m200.read_message_respiration_sleep()
return("respiration_rate: {} movement_slow: {} movement_fast: {}".format(rdata.respiration_rate, rdata.movement_slow, rdata.movement_fast)) """
except:
return('Messages output finish!')
#sys.exit(0)
def main():
ports = list(serial.tools.list_ports.comports())
for p in ports:
if("XeThru" in p.description):
print("XeThru found at:",p.device)
device_name = p.device
#device_name = 'ttyACM3'
#print_module_info(device_name)
record = False
x4m200 = configure_x4m200(
device_name, record, x4m200_par_settings)
while True:
print(print_x4m200_messages(x4m200))
if __name__ == "__main__":
main()