|
|
- import time
- import math
- import adafruit_lsm9ds1
- import board
- import busio
- import neopixel
-
- PURPLE = (180, 0, 255)
-
- i2c = busio.I2C(board.SCL, board.SDA)
- compass = adafruit_lsm9ds1.LSM9DS1_I2C(i2c)
- pixels = neopixel.NeoPixel(board.A1, 16, brightness=0.01, auto_write=False)
-
- # (x, y, z) tuples:
- MAG_MIN = (-0.25046, -0.23506, -0.322)
- MAG_MAX = (0.68278, 0.70882, 0.59654)
-
- def bearing_to_pixel(bearing, count=16):
- pixel = count - int(round((bearing / 360) * count))
- if (pixel == 16):
- pixel = 0
- return pixel
-
- def map_range(x, in_min, in_max, out_min, out_max):
- """
- Maps a number from one range to another.
- :return: Returns value mapped to new range
- :rtype: float
- """
- mapped = (x-in_min) * (out_max - out_min) / (in_max-in_min) + out_min
- if out_min <= out_max:
- return max(min(mapped, out_max), out_min)
-
- return min(max(mapped, out_max), out_min)
-
- while True:
- mag_x, mag_y, mag_z = compass.magnetometer
-
- mag_x = map_range(mag_x, MAG_MIN[0], MAG_MAX[0], -1, 1)
- mag_y = map_range(mag_y, MAG_MIN[1], MAG_MAX[1], -1, 1)
- mag_z = map_range(mag_z, MAG_MIN[2], MAG_MAX[2], -1, 1)
-
- compass_heading = (math.atan2(mag_y, mag_x) * 180) / math.pi;
- if compass_heading < 0:
- compass_heading = 360 + compass_heading;
-
- pixel = bearing_to_pixel(compass_heading)
-
- print('Magnetometer: ({0:10.3f}, {1:10.3f}, {2:10.3f})'.format(mag_x, mag_y, mag_z))
- print(compass_heading)
- print('Lighting pixel: {}'.format(pixel))
-
- pixels.fill((0,0,0))
- pixels[pixel] = PURPLE
- pixels.show()
-
- time.sleep(0.2)
|