01234567890123456789012345678901234567890123456789012345678901234567890123456789
645646647648649650651652653654655656657658659660661662663664 665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721 |
<----SKIPPED LINES---->
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---->
|
01234567890123456789012345678901234567890123456789012345678901234567890123456789
645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722 |
<----SKIPPED LINES---->
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)
timing.append((time.time(), 4))
# 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(), 5))
if time.time() >= next_read:
link.Read() # simple ack message sent by servos
next_read = time.time() + READ_DELAY_TIME
timing.append((time.time(), 6))
now = GetNow(json_desc_dict, additional_attr)
timing.append((time.time(), 7))
current_angles = AzimuthAltitude(flight, now)
timing.append((time.time(), 8))
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, threshold=0.2)
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.1))
# flight no longer tracked; send one more command to turn off lasers
elif flight_present:
timing = [(time.time(), 1.2)]
link.Write((*last_angles, *LASER_RGB_OFF))
flight_present = False
next_write = time.time() + WRITE_DELAY_TIME
else:
timing = timing = [(time.time(), 1.3)]
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---->
|