"""
Read heart rate data from a heart rate peripheral using the standard BLE
Heart Rate service.
"""

from time import time
import adafruit_ble
import board
from adafruit_ble_heart_rate import HeartRateService
import pyloton

# PyLint can't find BLERadio for some reason so special case it here.
ble = adafruit_ble.BLERadio()    # pylint: disable=no-member

display = board.DISPLAY


heart=True
speed=True
cad=True
ams=True
debug=False

# 84.229 is wheel circumference (700x23 in my case)
pyloton = pyloton.Pyloton(ble, display, 84.229, heart, speed, cad, ams, debug)

pyloton.show_splash()

pyloton.ams_connect()


start = time()
hr_connection = None
speed_cad_connections = []
radio = None
while True:
    if heart:
        if not hr_connection:
            print("Running hr_connection")
            hr_connection = pyloton.heart_connect()
            ble.stop_scan()
    if speed or cad:
        if not speed_cad_connections:
            print("Running speed_cad_connection")
            speed_cad_connections = pyloton.speed_cad_connect()

    if time()-start >= 45:
        pyloton.timeout()
        break
    # Stop scanning whether or not we are connected.
    ble.stop_scan()

    #if speed_cad_connections:
    # Comment out the following line and uncomment the previous line if you aren't using a
    # heart rate monitor
    if hr_connection and hr_connection.connected and speed_cad_connections:
        if heart:
            print("Fetch connection")
            hr_service = hr_connection[HeartRateService]
            print("Location:", hr_service.location)
        pyloton.setup_display()
        break

# Replace following line with while True if you aren't using a heart rate sensor
while hr_connection.connected:
    pyloton.update_display()
    pyloton.ams_remote()