首页 › M5Stack › M5StickV 使用入门教程

vany5921 发表于 2019-12-16 17:54

M5StickV 使用入门教程

本帖最后由 vany5921 于 2020-3-24 14:56 编辑

1.按键的使用
2.LED的使用
3.PWM的使用
4.查询I2C硬件
5.IMU-显示MPU6886数据
6.IMU-显示SH200Q数据
7.显示APX192数据
8.AXP192背光亮度控制
9.图像获取
10.SD卡保存图像
11.图像filter各类效果
12.图像高级处理
13.文件读取
14.MNIST识别
15.人脸识别
16.识别20分类
17.识别1000分类
18.播放WAV文件
19. 屏幕绘图
20.IMU控制画面

1.按键的使用
import lcd
from Maix import I2S, GPIO
from fpioa_manager import fm
from board import board_info

lcd.init()
fm.register(board_info.BUTTON_A, fm.fpioa.GPIO1)
but_a=GPIO(GPIO.GPIO1, GPIO.IN, GPIO.PULL_UP)

fm.register(board_info.BUTTON_B, fm.fpioa.GPIO2)
but_b = GPIO(GPIO.GPIO2, GPIO.IN, GPIO.PULL_UP)

but_a_pressed = 0
but_b_pressed = 0

while(True):
    if but_a.value() == 0 and but_a_pressed == 0:
      print("A_push")
      but_a_pressed=1
    if but_a.value() == 1 and but_a_pressed == 1:
      print("A_release")
      but_a_pressed=0

    if but_b.value() == 0 and but_b_pressed == 0:
      print("B_push")
      but_b_pressed=1
    if but_b.value() == 1 and but_b_pressed == 1:
      print("B_release")
      but_b_pressed=0

2.LED的使用
import lcd
from fpioa_manager import *
from Maix import GPIO
from board import board_info

fm.register(board_info.BUTTON_A, fm.fpioa.GPIO1)
but_a=GPIO(GPIO.GPIO1, GPIO.IN, GPIO.PULL_UP)

fm.register(board_info.BUTTON_B, fm.fpioa.GPIO2)
but_b = GPIO(GPIO.GPIO2, GPIO.IN, GPIO.PULL_UP)

fm.register(board_info.LED_W, fm.fpioa.GPIO3)
led_w = GPIO(GPIO.GPIO3, GPIO.OUT)
led_w.value(1) # LED is Active Low

fm.register(board_info.LED_R, fm.fpioa.GPIO4)
led_r = GPIO(GPIO.GPIO4, GPIO.OUT)
led_r.value(1) # LED is Active Low

fm.register(board_info.LED_G, fm.fpioa.GPIO5)
led_g = GPIO(GPIO.GPIO5, GPIO.OUT)
led_g.value(1) # LED is Active Low

fm.register(board_info.LED_B, fm.fpioa.GPIO6)
led_b = GPIO(GPIO.GPIO6, GPIO.OUT)
led_b.value(1) # LED is Active Low

lcd.init()
while(True):
    if but_a.value() == 0:
      led_w.value(0)
      led_r.value(1)
      led_g.value(1)
      led_b.value(1)

    elif but_b.value()== 0:
      led_w.value(1)
      led_r.value(0)
      led_g.value(1)
      led_b.value(1)

    else:
      led_w.value(1)
      led_r.value(1)
      led_g.value(1)
      led_b.value(1)


3.PWM的使用
import time,math
from machine import Timer,PWM
from fpioa_manager import fm
from board import board_info

tim = Timer(Timer.TIMER0, Timer.CHANNEL0, mode=Timer.MODE_PWM)
PWM_ch = PWM(tim, freq=500000, duty=0, pin=board_info.LED_W)
cnt=0
while(True):
    duty_val=math.fabs(math.sin(cnt))*100
    PWM_ch.duty(duty_val)
    cnt=cnt+0.01
    time.sleep_ms(10)

4.查询I2C硬件
from machine import I2C
i2c = I2C(I2C.I2C0, freq=100000, scl=28, sda=29)
devices = i2c.scan()
print(devices)

5.IMU-显示MPU6886数据
from machine import I2C
import lcd
MPU6886_ADDRESS=0x68
MPU6886_WHOAMI=0x75
MPU6886_ACCEL_INTEL_CTRL=0x69
MPU6886_SMPLRT_DIV=0x19
MPU6886_INT_PIN_CFG=   0x37
MPU6886_INT_ENABLE=0x38
MPU6886_ACCEL_XOUT_H=0x3B
MPU6886_TEMP_OUT_H=0x41
MPU6886_GYRO_XOUT_H=   0x43
MPU6886_USER_CTRL= 0x6A
MPU6886_PWR_MGMT_1=0x6B
MPU6886_PWR_MGMT_2=0x6C
MPU6886_CONFIG=0x1A
MPU6886_GYRO_CONFIG=   0x1B
MPU6886_ACCEL_CONFIG=0x1C
MPU6886_ACCEL_CONFIG2= 0x1D
MPU6886_FIFO_EN=   0x23

i2c = I2C(I2C.I2C0, freq=100000, scl=28, sda=29)
devices = i2c.scan()
time.sleep_ms(10)
print("i2c",devices)

def write_i2c(address, value):
    i2c.writeto_mem(MPU6886_ADDRESS, address, bytearray())
    time.sleep_ms(10)

def MPU6866_init():
    write_i2c(MPU6886_PWR_MGMT_1, 0x00)
    write_i2c(MPU6886_PWR_MGMT_1, 0x01<<7)
    write_i2c(MPU6886_PWR_MGMT_1,0x01<<0)
    write_i2c(MPU6886_ACCEL_CONFIG,0x10)
    write_i2c(MPU6886_GYRO_CONFIG,0x18)
    write_i2c(MPU6886_CONFIG,0x01)
    write_i2c(MPU6886_SMPLRT_DIV,0x05)
    write_i2c(MPU6886_INT_ENABLE,0x00)
    write_i2c(MPU6886_ACCEL_CONFIG2,0x00)
    write_i2c(MPU6886_USER_CTRL,0x00)
    write_i2c(MPU6886_FIFO_EN,0x00)
    write_i2c(MPU6886_INT_PIN_CFG,0x22)
    write_i2c(MPU6886_INT_ENABLE,0x01)

def MPU6866_read():
    accel = i2c.readfrom_mem(MPU6886_ADDRESS, MPU6886_ACCEL_XOUT_H, 6)
    accel_x = (accel<<8|accel)
    accel_y = (accel<<8|accel)
    accel_z = (accel<<8|accel)
    if accel_x>32768:
      accel_x=accel_x-65536
    if accel_y>32768:
      accel_y=accel_y-65536
    if accel_z>32768:
      accel_z=accel_z-65536
    return accel_x,accel_y,accel_z

MPU6866_init()
lcd.init()
lcd.clear()
aRes = 8.0/32768.0;
while True:
    x,y,z=MPU6866_read()
    accel_array =
    print(accel_array);
    lcd.draw_string(20,50,"x:"+str(accel_array))
    lcd.draw_string(20,70,"y:"+str(accel_array))
    lcd.draw_string(20,90,"z:"+str(accel_array))
    time.sleep_ms(10)

6.IMU-显示SH200Q数据
from machine import I2C
import lcd

i2c = I2C(I2C.I2C0, freq=100000, scl=28, sda=29)
devices = i2c.scan()
print("i2c",devices)

SH200I_ADDRESS=108
SH200I_WHOAMI= 0x30
SH200I_ACC_CONFIG= 0x0E
SH200I_GYRO_CONFIG= 0x0F
SH200I_GYRO_DLPF= 0x11
SH200I_FIFO_CONFIG= 0x12
SH200I_ACC_RANGE= 0x16
SH200I_GYRO_RANGE= 0x2B
SH200I_OUTPUT_ACC= 0x00
SH200I_OUTPUT_GYRO= 0x06
SH200I_OUTPUT_TEMP= 0x0C
SH200I_REG_SET1= 0xBA
SH200I_REG_SET2= 0xCA   #ADC reset
SH200I_ADC_RESET=0xC2   #drive reset
SH200I_SOFT_RESET= 0x7F
SH200I_RESET= 0x75

def write_i2c(address, value):
    i2c.writeto_mem(SH200I_ADDRESS, address, bytearray())
    time.sleep_ms(10)

def SH200I_init():
    # FIFO reset
    write_i2c(SH200I_FIFO_CONFIG, 0x00)
    # Chip ID default=0x18
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, 0x30, 1);
    print ("ChipID:", tempdata);

    #sh200i_ADCReset
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, SH200I_ADC_RESET, 1);
    tempdata = tempdata | 0x04
    write_i2c(SH200I_ADC_RESET, tempdata)
    tempdata = tempdata & 0xFB
    write_i2c(SH200I_ADC_RESET, tempdata)
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, 0xD8, 1)
    tempdata = tempdata | 0x80
    write_i2c(0xD8, tempdata)
    tempdata = tempdata & 0x7F;
    write_i2c(0xD8, tempdata)
    write_i2c(0x78, 0x61)
    write_i2c(0x78, 0x00)
    #set acc odr 256hz
    #   0x81 1024hz   //0x89 512hz    //0x91256hz
    write_i2c(SH200I_ACC_CONFIG, 0x91)
    # set gyro odr 500hz
    #0x11 1000hz    //0x13500hz   //0x15256hz
    write_i2c(SH200I_GYRO_CONFIG, 0x13)
    # set gyro dlpf 50hz
    #0x00 250hz   //0x01 200hz   0x02 100hz0x03 50hz0x04 25hz
    write_i2c(SH200I_GYRO_DLPF, 0x03)
    # set no buffer mode
    write_i2c(SH200I_FIFO_CONFIG, 0x00)
    # set acc range +-8G
    write_i2c(SH200I_ACC_RANGE, 0x01)
    # set gyro range +-2000DPS/s
    write_i2c(SH200I_GYRO_RANGE, 0x00)
    tempdata = 0xC0;
    write_i2c(SH200I_REG_SET1, 0xC0)
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, SH200I_REG_SET2, 1)
    tempdata = tempdata | 0x10
    # ADC Reset
    write_i2c(SH200I_REG_SET2, tempdata)
    tempdata = tempdata | 0xEF
    write_i2c(SH200I_REG_SET2, tempdata)

def SH200I_acc_read():
    accel = i2c.readfrom_mem(SH200I_ADDRESS, SH200I_OUTPUT_ACC, 6)
    accel_x = (accel<<8|accel);
    accel_y = (accel<<8|accel);
    accel_z = (accel<<8|accel);
    if accel_x>32768:
      accel_x=accel_x-65536
    if accel_y>32768:
      accel_y=accel_y-65536
    if accel_z>32768:
      accel_z=accel_z-65536
    return accel_x,accel_y,accel_z

SH200I_init()
lcd.init()
lcd.clear()
aRes = 8.0/32768.0;
while True:
    x,y,z=SH200I_acc_read()
    accel_array =
    print(accel_array);
    lcd.draw_string(20,50,"x:"+str(accel_array))
    lcd.draw_string(20,70,"y:"+str(accel_array))
    lcd.draw_string(20,90,"z:"+str(accel_array))
    time.sleep_ms(10)

7.显示APX192数据
import pmu,lcd
lcd.init()
lcd.clear()
axp = pmu.axp192()
axp.enableADCs(True)
while True:
    vbat = axp.getVbatVoltage()
    usb_vol = axp.getUSBVoltage()
    usb_cur = axp.getUSBInputCurrent()
    connext_vol = axp.getConnextVoltage()
    connext_input_current = axp.getConnextInputCurrent()
    bat_current= axp.getBatteryChargeCurrent()
    bat_dis_current = axp.getBatteryDischargeCurrent()
    bat_instant_watts = axp.getBatteryInstantWatts()
    temp = axp.getTemperature()

    lcd.draw_string(20,0,"usb_vol:"+str(usb_vol))
    lcd.draw_string(20,15,"usb_cur:"+str(usb_cur))
    lcd.draw_string(20,30,"connext_vol:"+str(connext_vol))
    lcd.draw_string(20,45,"connext_input_current:"+str(connext_input_current))
    lcd.draw_string(20,60,"bat_current:"+str(bat_current))
    lcd.draw_string(20,75,"bat_dis_current:"+str(bat_dis_current))
    lcd.draw_string(20,90,"bat_instant_watts:"+str(bat_instant_watts))
    lcd.draw_string(20,105,"temp:"+str(temp))


8.AXP192背光亮度控制
import lcd#for test
from machine import I2C
AXP192_ADDR=0x34
Backlight_ADDR=0x91
level=50
i2c = I2C(I2C.I2C0, freq=100000, scl=28, sda=29)
val = (level+7) << 4
i2c.writeto_mem(AXP192_ADDR, Backlight_ADDR,int(val))

9.图像获取
import sensor,image,lcd
lcd.init()
lcd.rotation(2)
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.run(1)
while True:
    img=sensor.snapshot()
    lcd.display(img)

10.SD卡保存图像
import sensor, image, lcd, os
from Maix import I2S, GPIO
from fpioa_manager import fm
from board import board_info
fm.register(board_info.BUTTON_A, fm.fpioa.GPIO1)
but_a=GPIO(GPIO.GPIO1, GPIO.IN, GPIO.PULL_UP)
fm.register(board_info.BUTTON_B, fm.fpioa.GPIO2)
but_b = GPIO(GPIO.GPIO2, GPIO.IN, GPIO.PULL_UP)
is_button_a = 0
is_button_b = 0

lcd.init()
lcd.rotation(2)
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.run(1)

path = "/sd/"
ext=".jpg"
cnt=0
img_read = image.Image()

#os.mkdir("save")
print(os.listdir())

while True:
    if is_button_b == 1:
      lcd.display(img_read)

    else :
      img=sensor.snapshot()
      lcd.display(img)

    if but_a.value() == 0 and is_button_a == 0:
      print("save image")
      cnt+=1
      fname=path+str(cnt)+ext
      print(fname)
      img.save(fname, quality=95)
      is_button_a=1

    if but_a.value() == 1 and is_button_a == 1:
      is_button_a=0

    if but_b.value() == 0 and is_button_b == 0:
      fname=path+str(cnt)+ext
      print(fname)
      img_read = image.Image(fname)
      is_button_b=1

    if but_b.value() == 1 and is_button_b == 1:
      is_button_b=0

11.图像filter各类效果
import sensor,image,lcd,gc,time,uos

from fpioa_manager import *
from Maix import I2S, GPIO
fm.register(board_info.BUTTON_A, fm.fpioa.GPIO1)
but_a=GPIO(GPIO.GPIO1, GPIO.IN, GPIO.PULL_UP)
fm.register(board_info.BUTTON_B, fm.fpioa.GPIO2)
but_b = GPIO(GPIO.GPIO2, GPIO.IN, GPIO.PULL_UP)

isButtonPressedA = 0
isButtonPressedB = 0

lcd.init()
lcd.rotation(2)
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.set_windowing((224, 224))
sensor.run(1)
cnt=0
while True:
    if but_a.value() == 0 and isButtonPressedA == 0:
      cnt=cnt+1
      isButtonPressedA=1

    if but_a.value() == 1 and isButtonPressedA == 1:
      isButtonPressedA=0
    img = sensor.snapshot()

    if cnt==1:
      img.negate()
      img.draw_string(10,60, "negate",color=(255,0,0))
    elif cnt==2:
      img.cartoon(seed_threshold=0.05, floating_thresholds=0.05)
      img.draw_string(10,60, "cartoon",color=(255,0,0))
    elif cnt==3:
      img.histeq(adaptive=True, clip_limit=3)
      img.draw_string(10,60, "histeq",color=(255,0,0))
    elif cnt==4:
      img.mode(1)
      img.draw_string(10,60, "mode",color=(255,0,0))
    elif cnt==5:
      thresholds = (90, 100, -128, 127, -128, 127)
      img.binary(, invert=False, zero=True)
      img.draw_string(10,60, "binary",color=(255,0,0))
    elif cnt==6:
      img.laplacian(1)
      img.draw_string(10,60, "laplacian",color=(255,0,0))
    elif cnt==7:
      img.gamma_corr(gamma = 0.5, contrast = 1.0, brightness = 0.0)
      img.draw_string(10,60, "gamma_corr",color=(255,0,0))
    elif cnt==8:
      img.gaussian(1)
      img.draw_string(10,60, "gaussian",color=(255,0,0))
    elif cnt==9:
      img.histeq()
      img.draw_string(10,60, "histeq",color=(255,0,0))
    elif cnt==10:
      img.lens_corr(strength = 1.8, zoom = 1.0)
      img.draw_string(10,60, "lens_corr",color=(255,0,0))
    elif cnt==11:
       img.linpolar(reverse=False)
       img.draw_string(10,60, "linpolar",color=(255,0,0))
    elif cnt==12:
       img.logpolar(reverse=False)
       img.draw_string(10,60, "logpolar",color=(255,0,0))
    elif cnt==13:
       img.mean(1)
       img.draw_string(10,60, "mean",color=(255,0,0))
    elif cnt==14:
       img.median(1, percentile=0.5)
       img.draw_string(10,60, "median",color=(255,0,0))
    elif cnt==15:
       img.midpoint(1, bias=0.5)
       img.draw_string(10,60, "midpoint",color=(255,0,0))
    elif cnt==16:
       img.bilateral(3, color_sigma=0.1, space_sigma=1)
       img.draw_string(10,60, "bilateral",color=(255,0,0))
    else :
      cnt=0

    lcd.display(img)


12.图像高级处理
import sensor, image, lcd, time
from fpioa_manager import fm
from Maix import I2S, GPIO

lcd.init()
lcd.rotation(2)
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.run(1)
origin = (0,0,0, 0,1,0, 0,0,0)
edge = (-1,-1,-1,-1,8,-1,-1,-1,-1)
sharp = (-1,-1,-1,-1,9,-1,-1,-1,-1)
relievo = (2,0,0,0,-1,0,0,0,-1)
fm.register(36, fm.fpioa.GPIO1)
but_a=GPIO(GPIO.GPIO1, GPIO.IN, GPIO.PULL_UP)
but_a_pressed = 0
but_b_pressed = 0
cnt=0
while True:
    if but_a.value() == 0 and but_a_pressed == 0:
      cnt=cnt+1
      print("A_push")
      but_a_pressed=1
    if but_a.value() == 1 and but_a_pressed == 1:
      print("A_release")
      but_a_pressed=0

    img=sensor.snapshot()
    if cnt==1:
      img.conv3(edge)
      img.draw_string(10,60, "edge",color=(255,0,0))
    elif cnt==2:
      img.conv3(sharp)
      img.draw_string(10,60, "sharp",color=(255,0,0))
    elif cnt==3:
      img.conv3(relievo)
      img.draw_string(10,60, "relievo",color=(255,0,0))
    else :
      cnt=0
    lcd.display(img)

13.文件读取
import os
devices = os.listdir("/")

if "flash" in devices:
    os.chdir("/flash")
    print("flash")
    print(os.listdir())
if "sd" in devices:
    os.chdir("/sd")
    print("sd")
    print(os.listdir())

14.MNIST识别
import sensor,lcd,image
import KPU as kpu
lcd.init()
lcd.rotation(2)
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.set_windowing((224, 224))
task = kpu.load("mnist.kmodel")
sensor.run(1)
while True:
    img = sensor.snapshot()
    lcd.display(img)
    img1=img.to_grayscale(1)      #转灰度图
    img2=img1.resize(28,28)         #调整大小为28x28
    a=img2.invert()               #图像反转
    a=img2.strech_char(1)         #预处理消除暗角
    lcd.display(img2,oft=(120,32))      #显示28x28图像
    a=img2.pix_to_ai();             #生成ai数据
    fmap=kpu.forward(task,img2)                #运行神经网络模型
    plist=fmap[:]                   #获取10个数字的概率
    pmax=max(plist)               #取出最高可能性
    max_index=plist.index(pmax)                #找出最高可能性数字
    lcd.draw_string(0,0,"%d: %.3f"%(max_index,pmax),lcd.WHITE,lcd.BLACK)

15.人脸识别
import sensor,image,lcd
import KPU as kpu
from fpioa_manager import *
from Maix import GPIO
from board import board_info
from fpioa_manager import fm
fm.register(board_info.LED_R, fm.fpioa.GPIO4)
led_r = GPIO(GPIO.GPIO4, GPIO.OUT)
led_r.value(1)

lcd.init()
lcd.rotation(2)
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.run(1)
task = kpu.load("facedetect.kmodel")

anchor = (1.889, 2.5245, 2.9465, 3.94056, 3.99987, 5.3658, 5.155437, 6.92275, 6.718375, 9.01025)
a = kpu.init_yolo2(task, 0.5, 0.3, 5, anchor)
img_lcd=image.Image()
while(True):
    img = sensor.snapshot()
    code = kpu.run_yolo2(task, img)
    face_detec=False
    if code:
      for i in code:
            a = img.draw_rectangle(i.rect())
            face_detec=True
    if face_detec:
      led_r.value(0)
    else:
      led_r.value(1)

    a = lcd.display(img)
a = kpu.deinit(task)


16.识别20分类
import sensor,image,lcd,time
import KPU as kpu

lcd.init()
lcd.rotation(2)
import lcd#for test
sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.run(1)
clock = time.clock()
classes = ['aeroplane', 'bicycle', 'bird', 'boat', 'bottle', 'bus', 'car', 'cat', 'chair', 'cow', 'diningtable', 'dog', 'horse', 'motorbike', 'person', 'pottedplant', 'sheep', 'sofa', 'train', 'tvmonitor']
task = kpu.load("20class.kmodel")
anchor = (1.08, 1.19, 3.42, 4.41, 6.63, 11.38, 9.42, 5.11, 16.62, 10.52)
a = kpu.init_yolo2(task, 0.5, 0.3, 5, anchor)
while(True):
    clock.tick()
    img = sensor.snapshot()
    code = kpu.run_yolo2(task, img)
    print(clock.fps())
    if code:
      for i in code:
            a=img.draw_rectangle(i.rect())
            a = lcd.display(img)
            for i in code:
                lcd.draw_string(i.x(), i.y(),
                classes, lcd.RED, lcd.WHITE)
                lcd.draw_string(i.x(), i.y()+12,
                '%f1.3'%i.value(), lcd.RED, lcd.WHITE)
    else:
      a = lcd.display(img)
a = kpu.deinit(task)

17.识别1000分类
import sensor, image, lcd, time
import KPU as kpu
lcd.init()
lcd.rotation(2)
lcd.clear()

sensor.reset()
sensor.set_pixformat(sensor.RGB565)
sensor.set_framesize(sensor.QVGA)
sensor.set_windowing((224, 224))
sensor.run(1)
lcd.draw_string(100,96,"MobileNet Demo")
lcd.draw_string(100,112,"Loading labels...")
f=open('labels.txt','r')
labels=f.readlines()
f.close()
task = kpu.load("mbnet751.kmodel")
clock = time.clock()
while(True):
    img = sensor.snapshot()
    clock.tick()
    fmap = kpu.forward(task, img)
    fps=clock.fps()
    plist=fmap[:]
    pmax=max(plist)
    max_index=plist.index(pmax)
    a = lcd.display(img)
    lcd.draw_string(10, 96, "%.2f:%s"%(pmax, labels.strip()))
    print(fps)
a = kpu.deinit(task)

18.播放WAV文件
from fpioa_manager import *
from Maix import I2S, GPIO
import audio


fm.register(board_info.SPK_SD, fm.fpioa.GPIO0)
spk_sd=GPIO(GPIO.GPIO0, GPIO.OUT)
spk_sd.value(1)
fm.register(board_info.SPK_DIN,fm.fpioa.I2S0_OUT_D1)
fm.register(board_info.SPK_BCLK,fm.fpioa.I2S0_SCLK)
fm.register(board_info.SPK_LRCLK,fm.fpioa.I2S0_WS)
wav_dev = I2S(I2S.DEVICE_0)


def play_wav(fname):
    player = audio.Audio(path = fname)
    player.volume(20)
    wav_info = player.play_process(wav_dev)
    wav_dev.channel_config(wav_dev.CHANNEL_1,
      I2S.TRANSMITTER,resolution = I2S.RESOLUTION_16_BIT,
      align_mode = I2S.STANDARD_MODE)
    wav_dev.set_sample_rate(wav_info)
    while True:
      ret = player.play()
      if ret == None:
            break
      elif ret==0:
            break
    player.finish()

fm.register(board_info.BUTTON_A, fm.fpioa.GPIO1)
but_a=GPIO(GPIO.GPIO1, GPIO.IN, GPIO.PULL_UP)
but_a_pressed = 0

while True:
    if but_a.value() == 0 and but_a_pressed == 0:
      play_wav("reset.wav")
      but_a_pressed=1
    if but_a.value() == 1 and but_a_pressed == 1:
      but_a_pressed=0

player.finish()

19. 屏幕绘图
import lcd,math,image
lcd.init()
lcd.rotation(2)
lcd.clear()
x_zero=240//2
y_zero=135//2
x_zero_rot=x_zero
y_zero_rot=y_zero+90

def rot(x_in,y_in,theta):
    x_rot = (x_in - x_zero) * math.cos(theta)- (y_in - y_zero) * math.sin(theta) + x_zero_rot;
    y_rot = (x_in - x_zero) * math.sin(theta) +(y_in - y_zero) * math.cos(theta) + y_zero_rot;
    return int(x_rot),int(y_rot)

def rot2(x_in1,y_in1,x_in2,y_in2,theta):
    x_rot1 = (x_in1 - x_zero) * math.cos(theta)- (y_in1 - y_zero) * math.sin(theta) + x_zero_rot;
    y_rot1 = (x_in1 - x_zero) * math.sin(theta)+(y_in1 - y_zero) * math.cos(theta) + y_zero_rot;
    x_rot2 = (x_in2 - x_zero) * math.cos(theta)- (y_in2 - y_zero) * math.sin(theta) + x_zero_rot;
    y_rot2 = (x_in2 - x_zero) * math.sin(theta)+(y_in2 - y_zero) * math.cos(theta) + y_zero_rot;
    return int(x_rot1),int(y_rot1),int(x_rot2),int(y_rot2)
   
def draw_face(img,theta,cnt):
    img.draw_rectangle(0,0,240,135,color = (255, 255, 0), fill = True)
    if cnt<100:
      res = rot(40,70,theta)#left_eye
      img.draw_circle(res, res, 42, color = (0, 0, 0),
            thickness = 2, fill = True)
      img.draw_circle(res, res, 40, color = (255, 255, 255),
            thickness = 2, fill = True)
      img.draw_circle(res, res, 30, color = (0, 0, 0),
            thickness = 2, fill = True)
      res = rot(200,70,theta) #right_eye
      img.draw_circle(res, res, 42, color = (0, 0, 0),
            thickness = 2, fill = True)
      img.draw_circle(res, res, 40, color = (255, 255, 255),
            thickness = 2, fill = True)
      img.draw_circle(res, res, 30, color = (0, 0, 0),
            thickness = 2, fill = True)
    else :
      res = rot2(10,70,80,70,theta)
      img.draw_line(res, res, res, res, color = (0, 0, 0),
            thickness = 10)
      res = rot2(170,70,250,70,theta)
      img.draw_line(res, res, res, res, color = (0, 0, 0),
            thickness = 10)

    res = rot2(170,10,240,-20,theta)
    img.draw_line(res, res, res, res, color = (0, 0, 0),
            thickness = 15)
    res = rot2(70,10,0,-20,theta)
    img.draw_line(res, res, res, res, color = (0, 0, 0),
            thickness = 15)

rot_theta=3.1415/2*3
cnt=0
while True:
    img = image.Image()
    draw_face(img,rot_theta,cnt)
    lcd.display(img)
    cnt+=1
    if cnt>200:
      cnt=0
    rot_theta=rot_theta+0.05

20.IMU控制画面
from machine import I2C
import lcd,math,image

####################
## 019_LCD_draw_face.py
x_zero=240//2
y_zero=135//2
x_zero_rot=x_zero
y_zero_rot=y_zero+0

def rot(x_in,y_in,theta):
    x_rot = (x_in - x_zero) * math.cos(theta)-(y_in - y_zero) * math.sin(theta) + x_zero_rot;
    y_rot = (x_in - x_zero) * math.sin(theta)      +(y_in - y_zero) * math.cos(theta) + y_zero_rot;
    return int(x_rot),int(y_rot)

def rot2(x_in1,y_in1,x_in2,y_in2,theta):
    x_rot1 = (x_in1 - x_zero) * math.cos(theta)      - (y_in1 - y_zero) * math.sin(theta) + x_zero_rot;
    y_rot1 = (x_in1 - x_zero) * math.sin(theta)      +(y_in1 - y_zero) * math.cos(theta) + y_zero_rot;
    x_rot2 = (x_in2 - x_zero) * math.cos(theta)      - (y_in2 - y_zero) * math.sin(theta) + x_zero_rot;
    y_rot2 = (x_in2 - x_zero) * math.sin(theta)      +(y_in2 - y_zero) * math.cos(theta) + y_zero_rot;
    return int(x_rot1),int(y_rot1),int(x_rot2),int(y_rot2)

def draw_face(img,theta,cnt):
    img.draw_rectangle(0,0,240,135,color = (255, 255, 0), fill = True)
    if cnt<100:
      res = rot(40,70,theta)#left_eye
      img.draw_circle(res, res, 42, color = (0, 0, 0),            thickness = 2, fill = True)
      img.draw_circle(res, res, 40, color = (255, 255, 255),            thickness = 2, fill = True)
      img.draw_circle(res, res, 30, color = (0, 0, 0),            thickness = 2, fill = True)
      res = rot(200,70,theta) #right_eye
      img.draw_circle(res, res, 42, color = (0, 0, 0),            thickness = 2, fill = True)
      img.draw_circle(res, res, 40, color = (255, 255, 255),            thickness = 2, fill = True)
      img.draw_circle(res, res, 30, color = (0, 0, 0),            thickness = 2, fill = True)
    else :
      res = rot2(10,70,80,70,theta)
      img.draw_line(res, res, res, res, color = (0, 0, 0),            thickness = 10)
      res = rot2(170,70,250,70,theta)
      img.draw_line(res, res, res, res, color = (0, 0, 0),            thickness = 10)

    res = rot2(170,10,240,-20,theta)
    img.draw_line(res, res, res, res, color = (0, 0, 0),            thickness = 15)
    res = rot2(70,10,0,-20,theta)
    img.draw_line(res, res, res, res, color = (0, 0, 0),            thickness = 15)

####################
## 005_imu_SH200Q.py

SH200I_ADDRESS=108
SH200I_WHOAMI= 0x30
SH200I_ACC_CONFIG= 0x0E
SH200I_GYRO_CONFIG= 0x0F
SH200I_GYRO_DLPF= 0x11
SH200I_FIFO_CONFIG= 0x12
SH200I_ACC_RANGE= 0x16
SH200I_GYRO_RANGE= 0x2B
SH200I_OUTPUT_ACC= 0x00
SH200I_OUTPUT_GYRO= 0x06
SH200I_OUTPUT_TEMP= 0x0C
SH200I_REG_SET1= 0xBA
SH200I_REG_SET2= 0xCA   #ADC reset
SH200I_ADC_RESET=0xC2   #drive reset
SH200I_SOFT_RESET= 0x7F
SH200I_RESET= 0x75

def write_i2c_sh200(address, value):
    i2c.writeto_mem(SH200I_ADDRESS, address, bytearray())
    time.sleep_ms(10)

def SH200I_init():
    # FIFO reset
    write_i2c_sh200(SH200I_FIFO_CONFIG, 0x00)
    # Chip ID default=0x18
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, 0x30, 1);
    print ("ChipID:", tempdata);

    #sh200i_ADCReset
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, SH200I_ADC_RESET, 1);
    tempdata = tempdata | 0x04
    write_i2c_sh200(SH200I_ADC_RESET, tempdata)
    tempdata = tempdata & 0xFB
    write_i2c_sh200(SH200I_ADC_RESET, tempdata)
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, 0xD8, 1)
    tempdata = tempdata | 0x80
    write_i2c_sh200(0xD8, tempdata)
    tempdata = tempdata & 0x7F;
    write_i2c_sh200(0xD8, tempdata)
    write_i2c_sh200(0x78, 0x61)
    write_i2c_sh200(0x78, 0x00)
    #set acc odr 256hz
    #   0x81 1024hz   //0x89 512hz    //0x91256hz
    write_i2c_sh200(SH200I_ACC_CONFIG, 0x91)
    # set gyro odr 500hz
    #0x11 1000hz    //0x13500hz   //0x15256hz
    write_i2c_sh200(SH200I_GYRO_CONFIG, 0x13)
    # set gyro dlpf 50hz
    #0x00 250hz   //0x01 200hz   0x02 100hz0x03 50hz0x04 25hz
    write_i2c_sh200(SH200I_GYRO_DLPF, 0x03)
    # set no buffer mode
    write_i2c_sh200(SH200I_FIFO_CONFIG, 0x00)
    # set acc range +-8G
    write_i2c_sh200(SH200I_ACC_RANGE, 0x01)
    # set gyro range +-2000DPS/s
    write_i2c_sh200(SH200I_GYRO_RANGE, 0x00)
    tempdata = 0xC0;
    write_i2c_sh200(SH200I_REG_SET1, 0xC0)
    tempdata = i2c.readfrom_mem(SH200I_ADDRESS, SH200I_REG_SET2, 1)
    tempdata = tempdata | 0x10
    # ADC Reset
    write_i2c_sh200(SH200I_REG_SET2, tempdata)
    tempdata = tempdata | 0xEF
    write_i2c_sh200(SH200I_REG_SET2, tempdata)

def SH200I_acc_read():
    accel = i2c.readfrom_mem(SH200I_ADDRESS, SH200I_OUTPUT_ACC, 6)
    accel_x = (accel<<8|accel);
    accel_y = (accel<<8|accel);
    accel_z = (accel<<8|accel);
    if accel_x>32768:
      accel_x=accel_x-65536
    if accel_y>32768:
      accel_y=accel_y-65536
    if accel_z>32768:
      accel_z=accel_z-65536
    return accel_x,accel_y,accel_z

####################
## 006_imu_MPU6886.py

MPU6886_ADDRESS=0x68
MPU6886_WHOAMI=0x75
MPU6886_ACCEL_INTEL_CTRL=0x69
MPU6886_SMPLRT_DIV=0x19
MPU6886_INT_PIN_CFG=   0x37
MPU6886_INT_ENABLE=0x38
MPU6886_ACCEL_XOUT_H=0x3B
MPU6886_TEMP_OUT_H=0x41
MPU6886_GYRO_XOUT_H=   0x43
MPU6886_USER_CTRL= 0x6A
MPU6886_PWR_MGMT_1=0x6B
MPU6886_PWR_MGMT_2=0x6C
MPU6886_CONFIG=0x1A
MPU6886_GYRO_CONFIG=   0x1B
MPU6886_ACCEL_CONFIG=0x1C
MPU6886_ACCEL_CONFIG2= 0x1D
MPU6886_FIFO_EN=   0x23

def write_i2c(address, value):
    i2c.writeto_mem(MPU6886_ADDRESS, address, bytearray())
    time.sleep_ms(10)

def MPU6866_init():
    write_i2c(MPU6886_PWR_MGMT_1, 0x00)
    write_i2c(MPU6886_PWR_MGMT_1, 0x01<<7)
    write_i2c(MPU6886_PWR_MGMT_1,0x01<<0)
    write_i2c(MPU6886_ACCEL_CONFIG,0x10)
    write_i2c(MPU6886_GYRO_CONFIG,0x18)
    write_i2c(MPU6886_CONFIG,0x01)
    write_i2c(MPU6886_SMPLRT_DIV,0x05)
    write_i2c(MPU6886_INT_ENABLE,0x00)
    write_i2c(MPU6886_ACCEL_CONFIG2,0x00)
    write_i2c(MPU6886_USER_CTRL,0x00)
    write_i2c(MPU6886_FIFO_EN,0x00)
    write_i2c(MPU6886_INT_PIN_CFG,0x22)
    write_i2c(MPU6886_INT_ENABLE,0x01)

def MPU6866_read():
    accel = i2c.readfrom_mem(MPU6886_ADDRESS, MPU6886_ACCEL_XOUT_H, 6)
    accel_x = (accel<<8|accel)
    accel_y = (accel<<8|accel)
    accel_z = (accel<<8|accel)
    if accel_x>32768:
      accel_x=accel_x-65536
    if accel_y>32768:
      accel_y=accel_y-65536
    if accel_z>32768:
      accel_z=accel_z-65536
    return accel_x,accel_y,accel_z

#####################


lcd.init()
lcd.rotation(2)
lcd.clear()
i2c = I2C(I2C.I2C0, freq=100000, scl=28, sda=29)
devices = i2c.scan()

if devices==: #SH200Q
    SH200I_init()
elif devices==: #MPU6866
    MPU6866_init()

cnt=0
rot_theta=0
x=0
y=0
z=0
while True:
    if devices==: #SH200Q
      x,y,z=SH200I_acc_read()
    elif devices==: #MPU6866
      x,y,z=MPU6866_read()
    accel_array =
    rot_theta=0.5*rot_theta-0.5*math.atan2(accel_array, -accel_array)
    img = image.Image()
    draw_face(img,rot_theta,cnt)
    lcd.display(img)
    cnt+=1
    if cnt>200:
      cnt=0

21.退出程序
import sensor, image, time
clock = time.clock()
print(clock.fps())
sys.exit()

肖佳杰 发表于 2020-1-18 23:44

太厉害了

laai 发表于 2020-2-8 18:48

我是新手，MAIXPY连上UNIT-V后，放上面的程序一个都不行？求指教

vany5921 发表于 2020-2-10 11:12

laai 发表于 2020-2-8 18:48
我是新手，MAIXPY连上UNIT-V后，放上面的程序一个都不行？求指教

两者在使用上有点区别 建议你去翻翻官方文档

laai 发表于 2020-2-13 20:52

14、MNIST识别
我刚买到的stick-V,有默认固件那个。
MAIXPY IDE里，放上你上面14的代码，显示有mnist.kmodel这行有错。请问这个要怎么弄？
问题：
1、我自己去别的地方找一个mnist.kmodel行不行，mnist.kmodel是不是通用的？
2、这个kmodel文件要放到哪里？SD卡吗？谢谢

vany5921 发表于 2020-2-17 09:24

laai 发表于 2020-2-13 20:52
14、MNIST识别
我刚买到的stick-V,有默认固件那个。
MAIXPY IDE里，放上你上面14的代码，显示有mnist.kmode ...

放到sd卡里，网上有K210用的mnist.kmodel

mikezhou 发表于 2020-4-10 09:50

你好。我把示例（10SD卡保存图像） 和 示例（16.识别20分类）结合在一起 ，后想保存分辨率高的片，VGA格式的。提示出错。这有什么办法办法没》？

yijia2202 发表于 2020-6-23 10:06

你好，我用最新的官方M5StickV固件，运行mnist, 显示版本错误。请问怎么解决？
ValueError: kpu: load error:2002, ERR_KMODEL_VERSION: only support kmodel V3/V4 now

Nicholas 发表于 2021-1-25 12:58

您好，请问如何使用M5StickV或者到了目标坐标过后，反馈给我的M5Core？

查看完整版本: M5StickV 使用入门教程