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)