01234567890123456789012345678901234567890123456789012345678901234567890123456789
176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218 642643644645646647648649650651652653654655656657658659660661662 663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698 699700701702703704705706707708709710711712713714715716717718 |
<----SKIPPED LINES---->
self.last_receipt = 0
self.reset_flag = True
self.link = None
self.name = name
self.__simulated_reads__ = None
if self.connection_type == CONNECTION_FLAG_BLUETOOTH:
self.open_function = OpenBluetooth
elif self.connection_type == CONNECTION_FLAG_USB:
self.open_function = OpenUSB
elif self.connection_type == CONNECTION_FLAG_SIMULATED:
self.open_function = None
if self.error_pin: # Error turned on when main initiated; turned off when connected
self.to_parent_q.put(('pin', (self.error_pin, True)))
self.start_time = time.time()
def __str__(self):
return '%s @ %s opened @ %s' % (
self.name, str(self.connection_tuple),
messageboard.EpochDisplayTime(self.start_time))
def Open(self):
"""Opens an instantiated serial connection for reading and writing."""
if self.connection_type == CONNECTION_FLAG_SIMULATED:
lines = []
if os.path.exists(self.connection_tuple[0]):
with open(self.connection_tuple[0], 'r') as f:
for line in f:
if line.strip():
lines.append(eval(line)) # pylint: disable=W0123
else:
Log('File %s does not exist for simulated commands to Arudino'
% self.connection_tuple[0], self.link)
self.__simulated_reads__ = lines
# clear out file so that shell tail -f process can continue to point to same file
with open(self.connection_tuple[1], 'w') as f:
f.write('')
if self.error_pin:
<----SKIPPED LINES---->
while not shutdown.value:
timing.append((time.time(), 2))
if not to_arduino_q.empty():
flight, json_desc_dict, configuration, additional_attr = to_arduino_q.get(
block=False)
if 'test_servos' in configuration:
messageboard.RemoveSetting(configuration, 'test_servos')
link.Write((0, 0, *LASER_RGB_OFF))
time.sleep(1)
link.Write((90, 0, *LASER_RGB_OFF))
time.sleep(1)
link.Write((180, 0, *LASER_RGB_OFF))
time.sleep(1)
link.Write((270, 0, *LASER_RGB_OFF))
timing.append((time.time(), 3))
new_flight = DifferentFlights(flight, last_flight)
if new_flight:
Log('Flight changed: %s' % messageboard.DisplayFlightNumber(flight), ser=link)
# Turn off laser so that line isn't traced while it moves to new position
link.Write((*last_angles, *LASER_RGB_OFF))
last_flight = flight
timing.append((time.time(), 4))
if time.time() >= next_read:
link.Read() # simple ack message sent by servos
next_read = time.time() + READ_DELAY_TIME
timing.append((time.time(), 5))
now = GetNow(json_desc_dict, additional_attr)
timing.append((time.time(), 6))
current_angles = AzimuthAltitude(flight, now)
timing.append((time.time(), 7))
if current_angles and time.time() > next_write:
if current_angles[1] >= configuration['minimum_altitude_servo_tracking']:
Log('Flight #: %s current_angles: %s' % (
messageboard.DisplayFlightNumber(flight), str(current_angles)))
messageboard.LogTimes(timing)
flight_present = True
laser_rgb = LaserRGBFlight(flight)
timing = [(time.time(), 0)]
link.Write((*current_angles, *laser_rgb))
last_angles = current_angles
timing.append((time.time(), 1))
# flight no longer tracked; send one more command to turn off lasers
elif flight_present:
timing = [(time.time(), -1)]
link.Write((*last_angles, *LASER_RGB_OFF))
flight_present = False
next_write = time.time() + WRITE_DELAY_TIME
link.Close(SHUTDOWN_TEXT)
LASER_RGB_OFF = (0, 0, 0)
def LaserRGBFlight(flight):
"""Based on flight attributes, set the laser."""
if not flight:
return LASER_RGB_OFF
return 1, 0, 0
def DifferentFlights(f1, f2):
"""True if flights same except for persistent path; False if they differ.
We cannot simply check if two flights are identical by checking equality of the dicts,
because a few attributes are updated after the flight is first found:
- the persistent_path is kept current
- cached_* attributes may be updated
- the insights are generated after flight first enqueued
<----SKIPPED LINES---->
|
01234567890123456789012345678901234567890123456789012345678901234567890123456789
176177178179180181182183184185186187188189190191192193194195196 197198199200201202203204205206207208209210211212213214215216 640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721 |
<----SKIPPED LINES---->
self.last_receipt = 0
self.reset_flag = True
self.link = None
self.name = name
self.__simulated_reads__ = None
if self.connection_type == CONNECTION_FLAG_BLUETOOTH:
self.open_function = OpenBluetooth
elif self.connection_type == CONNECTION_FLAG_USB:
self.open_function = OpenUSB
elif self.connection_type == CONNECTION_FLAG_SIMULATED:
self.open_function = None
if self.error_pin: # Error turned on when main initiated; turned off when connected
self.to_parent_q.put(('pin', (self.error_pin, True)))
self.start_time = time.time()
def __str__(self):
return self.name
def Open(self):
"""Opens an instantiated serial connection for reading and writing."""
if self.connection_type == CONNECTION_FLAG_SIMULATED:
lines = []
if os.path.exists(self.connection_tuple[0]):
with open(self.connection_tuple[0], 'r') as f:
for line in f:
if line.strip():
lines.append(eval(line)) # pylint: disable=W0123
else:
Log('File %s does not exist for simulated commands to Arudino'
% self.connection_tuple[0], self.link)
self.__simulated_reads__ = lines
# clear out file so that shell tail -f process can continue to point to same file
with open(self.connection_tuple[1], 'w') as f:
f.write('')
if self.error_pin:
<----SKIPPED LINES---->
while not shutdown.value:
timing.append((time.time(), 2))
if not to_arduino_q.empty():
flight, json_desc_dict, configuration, additional_attr = to_arduino_q.get(
block=False)
if 'test_servos' in configuration:
messageboard.RemoveSetting(configuration, 'test_servos')
link.Write((0, 0, *LASER_RGB_OFF))
time.sleep(1)
link.Write((90, 0, *LASER_RGB_OFF))
time.sleep(1)
link.Write((180, 0, *LASER_RGB_OFF))
time.sleep(1)
link.Write((270, 0, *LASER_RGB_OFF))
timing.append((time.time(), 3))
new_flight = DifferentFlights(flight, last_flight)
if new_flight:
Log('Flight changed from %s to %s' % (
messageboard.DisplayFlightNumber(last_flight),
messageboard.DisplayFlightNumber(flight)
), ser=link)
# Turn off laser so that line isn't traced while it moves to new position
link.Write((*last_angles, *LASER_RGB_OFF))
last_flight = flight
timing.append((time.time(), 4))
if time.time() >= next_read:
link.Read() # simple ack message sent by servos
next_read = time.time() + READ_DELAY_TIME
timing.append((time.time(), 5))
now = GetNow(json_desc_dict, additional_attr)
timing.append((time.time(), 6))
current_angles = AzimuthAltitude(flight, now)
timing.append((time.time(), 7))
if current_angles and time.time() > next_write:
if current_angles[1] >= configuration['minimum_altitude_servo_tracking']:
Log('Flight #: %s current_angles: %s' % (
messageboard.DisplayFlightNumber(flight), str(current_angles)))
messageboard.LogTimes(timing)
flight_present = True
laser_rgb = LaserRGBFlight(flight)
timing = [(time.time(), 0)]
link.Write((*current_angles, *laser_rgb))
last_angles = current_angles
timing.append((time.time(), 1))
# flight no longer tracked; send one more command to turn off lasers
elif flight_present:
timing = [(time.time(), -1)]
link.Write((*last_angles, *LASER_RGB_OFF))
flight_present = False
next_write = time.time() + WRITE_DELAY_TIME
else:
timing = timing = [(time.time(), -2)]
link.Close(SHUTDOWN_TEXT)
LASER_RGB_OFF = (0, 0, 0)
def LaserRGBFlight(flight):
"""Based on flight attributes, set the laser."""
if not flight:
return LASER_RGB_OFF
return 1, 0, 0
def DifferentFlights(f1, f2):
"""True if flights same except for persistent path; False if they differ.
We cannot simply check if two flights are identical by checking equality of the dicts,
because a few attributes are updated after the flight is first found:
- the persistent_path is kept current
- cached_* attributes may be updated
- the insights are generated after flight first enqueued
<----SKIPPED LINES---->
|