设为首页收藏本站
首页 > 论坛 > ESP32

[MP动手做]MicroPython动手做（20）——掌控板之三轴加速度

驴友花雕 | 中级技神 | 创造力： | 帖子： | 发消息 | 串个门 | 加好友 | 打招呼
2020-4-27 11:23:26 [显示全部楼层]
11838浏览
53回复
1收藏
楼主: 驴友花雕

[MP动手做] MicroPython动手做（20）——掌控板之三轴加速度

[复制链接]

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 11:40:35

mPython X 图形编程

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 12:47:47

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 19:10:49

15、倾斜和摇晃的一双眼睛

#MicroPython动手做（20）——掌控板之三轴加速度
#倾斜和摇晃的一双眼睛（应用字典函数）

  1. #MicroPython动手做（20）——掌控板之三轴加速度

  2. #倾斜和摇晃的一双眼睛（应用字典函数）

  3. 

  4. from mpython import *

  5. from machine import Timer

  6. import time

  7. 

  8. _is_shaked = _is_thrown = False

  9. _last_x = _last_y = _last_z = _count_shaked = _count_thrown = 0

  10. def on_shaked():pass

  11. def on_thrown():pass

  12. 

  13. tim11 = Timer(11)

  14. 

  15. def timer11_tick(_):

  16.     global _is_shaked, _is_thrown, _last_x, _last_y, _last_z, _count_shaked, _count_thrown

  17.     if _is_shaked:

  18.         _count_shaked += 1

  19.         if _count_shaked == 5: _count_shaked = 0

  20.     if _is_thrown:

  21.         _count_thrown += 1

  22.         if _count_thrown == 10: _count_thrown = 0

  23.         if _count_thrown > 0: return

  24.     x=accelerometer.get_x(); y=accelerometer.get_y(); z=accelerometer.get_z()

  25.     _is_thrown = (x * x + y * y + z * z < 0.25)

  26.     if _is_thrown: on_thrown();return

  27.     if _last_x == 0 and _last_y == 0 and _last_z == 0:

  28.         _last_x = x; _last_y = y; _last_z = z; return

  29.     diff_x = x - _last_x; diff_y = y - _last_y; diff_z = z - _last_z

  30.     _last_x = x; _last_y = y; _last_z = z

  31.     if _count_shaked > 0: return

  32.     _is_shaked = (diff_x * diff_x + diff_y * diff_y + diff_z * diff_z > 1)

  33.     if _is_shaked: on_shaked()

  34. 

  35. tim11.init(period=100, mode=Timer.PERIODIC, callback=timer11_tick)

  36. 

  37. _dir = ''

  38. def on_tilt_forward():pass

  39. def on_tilt_back():pass

  40. def on_tilt_right():pass

  41. def on_tilt_left():pass

  42. def on_tilt_none():pass

  43. 

  44. tim14 = Timer(14)

  45. 

  46. def timer14_tick(_):

  47.     global _dir

  48.     if accelerometer.get_x() < -0.3:

  49.         if 'F' != _dir:_dir = 'F';on_tilt_forward()

  50.     elif accelerometer.get_x() > 0.3:

  51.         if 'B' != _dir:_dir = 'B';on_tilt_back()

  52.     elif accelerometer.get_y() < -0.3:

  53.         if 'R' != _dir:_dir = 'R';on_tilt_right()

  54.     elif accelerometer.get_y() > 0.3:

  55.         if 'L' != _dir:_dir = 'L';on_tilt_left()

  56.     else:

  57.         if '' != _dir:_dir = '';on_tilt_none()

  58. 

  59. tim14.init(period=200, mode=Timer.PERIODIC, callback=timer14_tick)

  60. 

  61. def on_tilt_forward():

  62.     global face, dt_faces

  63.     face = dt_faces.get("Up")

  64. 

  65. def on_tilt_back():

  66.     global face, dt_faces

  67.     face = dt_faces.get("Down")

  68. 

  69. def on_tilt_left():

  70.     global face, dt_faces

  71.     face = dt_faces.get("Left")

  72. 

  73. def on_tilt_right():

  74.     global face, dt_faces

  75.     face = dt_faces.get("Right")

  76. 

  77. def on_tilt_none():

  78.     global face, dt_faces

  79.     face = dt_faces.get("Neutral")

  80. 

  81. image_picture = Image()

  82. 

  83. 

  84. dt_faces = {"Neutral":image_picture.load('face/Eyes/Neutral.pbm', 0), "Up":image_picture.load('face/Eyes/Up.pbm', 0), "Down":image_picture.load('face/Eyes/Down.pbm', 0), "Left":image_picture.load('face/Eyes/Middle left.pbm', 0), "Right":image_picture.load('face/Eyes/Middle right.pbm', 0), "Dizzy":image_picture.load('face/Eyes/Dizzy.pbm', 0)}

  85. face = dt_faces.get("Neutral")

  86. while True:

  87.     oled.fill(0)

  88.     if _is_shaked:

  89.         oled.blit(dt_faces.get("Dizzy"), 20, 0)

  90.         oled.show()

  91.         time.sleep_ms(2000)

  92.     else:

  93.         oled.blit(face, 20, 0)

  94.         oled.show()
复制代码

字典
字典是一种可变容器模型，且可存储任意类型对象，格式如 d = {key1 : value1, key2 : value2}，键必须是唯一的，但值则不必。

回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 19:15:34

mPython X 图形编程

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 19:23:21

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 19:30:40

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 19:49:52

16、水平仪和测量角度

#MicroPython动手做（20）——掌控板之三轴加速度
#水平仪和测量角度

[mw_shl_code=python,false]#MicroPython动手做（20）——掌控板之三轴加速度
#水平仪和测量角度

from mpython import *
import math
import framebuf
import font.dvsm_12
import time

def get_tilt_angle(_axis):
    _Ax = accelerometer.get_x()
    _Ay = accelerometer.get_y()
    _Az = accelerometer.get_z()
    if 'X' == _axis:
        _T = math.sqrt(_Ay ** 2 + _Az ** 2)
        if _Az < 0: return math.degrees(math.atan2(_Ax , _T))
        else: return 180 - math.degrees(math.atan2(_Ax , _T))
    elif 'Y' == _axis:
        _T = math.sqrt(_Ax ** 2 + _Az ** 2)
        if _Az < 0: return math.degrees(math.atan2(_Ay , _T))
        else: return 180 - math.degrees(math.atan2(_Ay , _T))
    elif 'Z' == _axis:
        _T = math.sqrt(_Ax ** 2 + _Ay ** 2)
        if (_Ax + _Ay) < 0: return 180 - math.degrees(math.atan2(_T , _Az))
        else: return math.degrees(math.atan2(_T , _Az)) - 180
    return 0

def display_font(_font, _str, _x, _y, _wrap, _z=0):
    _start = _x
    for _c in _str:
        _d = _font.get_ch(_c)
        if _wrap and _x > 128 - _d[2]: _x = _start; _y += _d[1]
        if _c == '1' and _z > 0: oled.fill_rect(_x, _y, _d[2], _d[1], 0)
        oled.blit(framebuf.FrameBuffer(bytearray(_d[0]), _d[2], _d[1],
        framebuf.MONO_HLSB), (_x+int(_d[2]/_z)) if _c=='1' and _z>0 else _x, _y)
        _x += _d[2]


while True:
    Tx = get_tilt_angle('X')
    oled.fill(0)
    display_font(font.dvsm_12, (str(" Angle :") + str(Tx)), 0, 0, False)
    oled.circle(64, 60, 46, 1)
    oled.fill_circle(64, 60, 5, 1)
    Dx = int((64 + math.cos(math.radians(Tx)) * 46))
    Dy = int((60 - math.fabs(math.sin(math.radians(Tx)) * 46)))
    oled.hline(0, 60, 128, 1)
    oled.line(64, 60, Dx, Dy, 1)
    oled.fill_rect(0, 61, 128, 3, 0)
    oled.vline(64, 61, 2, 1)
    Lx = int(numberMap(accelerometer.get_y(),(-1),1,128,0))
    oled.vline(Lx, 61, 3, 1)
    if Lx == 64:
        rgb.fill((int(0), int(51), int(0)))
        rgb.write()
        time.sleep_ms(1)
        oled.fill_circle(13, 20, 3, 1)
        oled.hline(7, 20, 13, 1)
    else:
        oled.fill_rect(7, 16, 13, 6, 0)
        rgb.fill( (0, 0, 0) )
        rgb.write()
        time.sleep_ms(1)
    oled.show()[/mw_shl_code]

回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 20:06:33

mPython X 图形编程

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-8 20:21:13

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-9 09:48:49

17、掌控闪灯大量程计步器（十万步）

#MicroPython动手做（20）——掌控板之三轴加速度
#掌控闪灯大量程计步器（十万步）

  1. #MicroPython动手做（20）——掌控板之三轴加速度

  2. #掌控闪灯大量程计步器（十万步）

  3. 

  4. from mpython import *

  5. 

  6. from machine import Timer

  7. 

  8. _is_shaked = _is_thrown = False

  9. _last_x = _last_y = _last_z = _count_shaked = _count_thrown = 0

  10. def on_shaked():pass

  11. def on_thrown():pass

  12. 

  13. tim11 = Timer(11)

  14. 

  15. def timer11_tick(_):

  16.     global _is_shaked, _is_thrown, _last_x, _last_y, _last_z, _count_shaked, _count_thrown

  17.     if _is_shaked:

  18.         _count_shaked += 1

  19.         if _count_shaked == 5: _count_shaked = 0

  20.     if _is_thrown:

  21.         _count_thrown += 1

  22.         if _count_thrown == 10: _count_thrown = 0

  23.         if _count_thrown > 0: return

  24.     x=accelerometer.get_x(); y=accelerometer.get_y(); z=accelerometer.get_z()

  25.     _is_thrown = (x * x + y * y + z * z < 0.25)

  26.     if _is_thrown: on_thrown();return

  27.     if _last_x == 0 and _last_y == 0 and _last_z == 0:

  28.         _last_x = x; _last_y = y; _last_z = z; return

  29.     diff_x = x - _last_x; diff_y = y - _last_y; diff_z = z - _last_z

  30.     _last_x = x; _last_y = y; _last_z = z

  31.     if _count_shaked > 0: return

  32.     _is_shaked = (diff_x * diff_x + diff_y * diff_y + diff_z * diff_z > 1)

  33.     if _is_shaked: on_shaked()

  34. 

  35. tim11.init(period=100, mode=Timer.PERIODIC, callback=timer11_tick)

  36. 

  37. import time

  38. 

  39. import framebuf

  40. 

  41. import font.digiface_30

  42. 

  43. def display_font(_font, _str, _x, _y, _wrap, _z=0):

  44.     _start = _x

  45.     for _c in _str:

  46.         _d = _font.get_ch(_c)

  47.         if _wrap and _x > 128 - _d[2]: _x = _start; _y += _d[1]

  48.         if _c == '1' and _z > 0: oled.fill_rect(_x, _y, _d[2], _d[1], 0)

  49.         oled.blit(framebuf.FrameBuffer(bytearray(_d[0]), _d[2], _d[1],

  50.         framebuf.MONO_HLSB), (_x+int(_d[2]/_z)) if _c=='1' and _z>0 else _x, _y)

  51.         _x += _d[2]

  52. bbb = 0

  53. while True:

  54.     oled.fill(0)

  55.     oled.DispChar('掌控计步器', 35, 2, 1)

  56.     oled.DispChar('步', 115, 40, 1)

  57.     if _is_shaked:

  58.         rgb.fill((int(0), int(102), int(0)))

  59.         rgb.write()

  60.         time.sleep_ms(1)

  61.         time.sleep_ms(60)

  62.         rgb.fill((int(0), int(0), int(0)))

  63.         rgb.write()

  64.         time.sleep_ms(1)

  65.         bbb = bbb + 1

  66.     else:

  67.         rgb.fill((int(153), int(0), int(0)))

  68.         rgb.write()

  69.         time.sleep_ms(1)

  70.     if bbb >= 0 and bbb <= 9:

  71.         display_font(font.digiface_30, (str(bbb)), 55, 24, False, 2)

  72.     elif bbb >= 9 and bbb <= 99:

  73.         display_font(font.digiface_30, (str(bbb)), 45, 24, False, 2)

  74.     elif bbb >= 99 and bbb <= 999:

  75.         display_font(font.digiface_30, (str(bbb)), 35, 24, False, 2)

  76.     elif bbb >= 999 and bbb <= 9999:

  77.         display_font(font.digiface_30, (str(bbb)), 20, 24, False, 2)

  78.     elif bbb >= 9999 and bbb <= 99999:

  79.         display_font(font.digiface_30, (str(bbb)), 10, 24, False, 2)

  80.     oled.show()
复制代码

注解
使用摇晃模块，优点是算法简单，不足之处是触发计步的阙值是固定的，不能调整

回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-9 10:07:48

mPython  图形编程

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

驴友花雕  中级技神
 楼主|

发表于 2020-5-9 11:34:07

MicroPython动手做（20）——掌控板之三轴加速度图1
回复

使用道具 举报

123
高级模式
B Color Image Link Quote Code Smilies
您需要登录后才可以回帖 登录 | 立即注册

本版积分规则

为本项目制作心愿单
购买心愿单
心愿单 编辑
[[wsData.name]]

硬件清单

  • [[d.name]]
btnicon
我也要做!
点击进入购买页面
撰写新帖
关于楼主
勋章墙
萌萌哒新人 活跃会员 宣传大使 牛X认证 创作达人 ARD DAY 摸鱼团员 志“童”道合 编辑选择奖

楼主的其它帖子

background 创造力兑换 background 心愿单 background 创客导航
上海智位机器人股份有限公司 沪ICP备09038501号-4 备案 沪公网安备31011502402448

© 2013-2025 Comsenz Inc. Powered by Discuz! X3.4 Licensed

mail