def main():
sw_state = False
led = pyb.LED(1)
switch = pyb.Switch()
switch.callback(set_sw_state)
accel = STAccel()
hid = pyb.USB_HID()
while True:
if sw_state:
x, y, z = accel.xyz()
hid.send((0, int(x * MAG), int(-y * MAG), 0))
pyb.delay(int(1000 / FREQ))
def main():
sw_state = False
led = pyb.LED(1)
switch = pyb.Switch()
switch.callback(set_sw_state)
accel = STAccel()
hid = pyb.USB_HID()
while True:
if sw_state:
x, y, z = accel.xyz()
hid.send((0, int(x * MAG), int(-y * MAG), 0))
pyb.delay(int(1000 / FREQ))
return (x_diff, y_diff)
def getRevDiff(y):
y_diff = 0
if y > up_threshold:
y_diff = -(y - up_threshold)
elif y < down_threshold:
y_diff = -(y - down_threshold)
return y_diff
while True:
x, y, z = accel.xyz()
print((x, y, z))
#print(x, y, z)
# abs_accel = math.sqrt(x**2 + y**2 + z**2)
if isClicked(z):
print("click!")
pyb.hid((1, 0, 0, 0))
elif isReversed(z):
y_diff = getRevDiff(y)
pyb.hid((0, 0, 0, int(y_diff * 10)))
else:
x_diff, y_diff = getDiff(x, y)
# if x_diff or y_diff:
# print((int(x_diff*20),int(y_diff*20)))
import pyb
from pyb import Pin
from staccel import STAccel
from sc1602 import SC1602
lcd_pin = {
'RS': Pin.board.PB8,
'E': Pin.board.PB9,
'DB0': Pin.board.PE6,
'DB1': Pin.board.PC13,
'DB2': Pin.board.PE4,
'DB3': Pin.board.PE5,
'DB4': Pin.board.PB4,
'DB7': Pin.board.PB7,
'DB6': Pin.board.PD7,
'DB5': Pin.board.PB5,
}
accel = STAccel()
lcd = SC1602(lcd_pin)
lcd.initialize()
while True:
x, y, z = accel.xyz()
lcd.set_cursor(0, 0)
lcd.write("X:{0:+5.02f} Y:{1:+5.02f} ".format(x, y))
lcd.set_cursor(1, 0)
lcd.write("Z:{0:+5.02f} ".format(z))
pyb.delay(100)
