Detect up to 3 different distance_sensors, keep track of them all I2C is tracked on its own, AD1 and AD2 are tracked in known_sensors
()
| 52 | logger.info ("Scratch Interpreter closed") |
| 53 | |
| 54 | def detect_distance_sensor(): |
| 55 | ''' |
| 56 | Detect up to 3 different distance_sensors, keep track of them all |
| 57 | I2C is tracked on its own, AD1 and AD2 are tracked in known_sensors |
| 58 | ''' |
| 59 | global distance_sensor |
| 60 | |
| 61 | # I2C |
| 62 | try: |
| 63 | distance_sensor = gpg.init_distance_sensor() |
| 64 | except: |
| 65 | distance_sensor = None |
| 66 | |
| 67 | if distance_sensor != None: |
| 68 | print ("Distance Sensor on I2C is detected") |
| 69 | # else: |
| 70 | # print ("Distance Sensor on I2C NOT detected") |
| 71 | |
| 72 | # AD1 |
| 73 | try: |
| 74 | distance_sensor_AD1 = gpg.init_distance_sensor(port="AD1") |
| 75 | except Exception as e: |
| 76 | # print(e) |
| 77 | distance_sensor_AD1 = None |
| 78 | |
| 79 | if distance_sensor_AD1 != None: |
| 80 | print ("Distance Sensor on AD1 is detected") |
| 81 | known_sensors["AD1"] = distance_sensor_AD1 |
| 82 | # else: |
| 83 | # print ("Distance Sensor on AD1 NOT detected") |
| 84 | |
| 85 | # AD2 |
| 86 | try: |
| 87 | distance_sensor_AD2 = gpg.init_distance_sensor(port="AD2") |
| 88 | except Exception as e: |
| 89 | # print(e) |
| 90 | distance_sensor_AD2 = None |
| 91 | |
| 92 | if distance_sensor_AD2 != None: |
| 93 | print ("Distance Sensor on AD2 is detected") |
| 94 | known_sensors["AD2"] = distance_sensor_AD2 |
| 95 | # else: |
| 96 | # print ("Distance Sensor on AD2 NOT detected") |
| 97 | |
| 98 | |
| 99 | ################################################################## |
no test coverage detected