创客.掌控板.加速度
加速度
加速度传感器能够测量由于重力引起的加速度,传感器在加速过程中,通过对质量块所受惯性力的测量,利用牛顿第二定律获得加速度值。掌控板上的加速度计可测量加速度,测量范围为 -2g 到 +2g 之间。
掌控板的测量沿3个轴,每个轴的测量值是正数或负数,正轴越趋近重力加速度方向,其数值往正数方向增加,反之往负数方向减小,当读数为 0 时,表示沿着该特定轴“水平”放置。
- X - 向前和向后倾斜。
- Y - 向左和向右倾斜。
- Z - 上下翻转。
例:通过OLED显示屏来观察3个轴加速度值的变化
from mpython import * while True: oled.fill(0) x1 = accelerometer.get_x() y1 = accelerometer.get_y() z1 = accelerometer.get_z() oled.DispChar("加速度x:", 0, 0) oled.DispChar(str(x1), 48, 0) oled.DispChar("加速度y:", 0, 16) oled.DispChar(str(y1), 48, 16) oled.DispChar("加速度z:", 0, 32) oled.DispChar(str(z1), 48, 32) oled.show()
使用前,导入mpython模块:
from mpython import *
获取X、Y、Z三轴的加速度:
x1 = accelerometer.get_x() y1 = accelerometer.get_y() z1 = accelerometer.get_z()
注解: 通过 accelerometer.get_x() 获取3轴加速度。获取3轴加速度获取方法分别为 get_x() 、get_y() 、get_z() 。
每个轴的测量值根据方向是正数或负数,表示以克为单位的值。
您可以尝试掌控板按以下放置,观察3轴数据:
- 平放桌面 --(0,0,-1)
- 翻转平放桌面 --(0,0,1)
- 掌控板下板边直立与桌面 --(1,0,0)
- 掌控板左板边直立与桌面 --(0,1,0)
注解:
发现什么规律没有?当重力加速度与加速度轴方向一致时,即等于1g的地球重力加速度。正方向为+1g,反方向为-1g。 假如您猛烈地摇动掌控板,您会看到加速度达到±2g,那是因为这个加速度计的最大测量值为±2g。
水平球
我们用加速度计制作一个上下左右各滚动的水平球from mpython import * #导入mpython模块 Center_x=63 #设定中心点(原点)x的坐标 Center_y=31 #设定中心点(原点)y的坐标 while True: x=accelerometer.get_x() #获取X轴的加速度 y=accelerometer.get_y() #获取Y轴的加速度 if y<=1 and y>=-1: offsetX=int(numberMap(y,1,-1,-64,64)) #映射Y轴偏移值 if x<=1 and x>=-1: offsetY=int(numberMap(x,1,-1,32,-32)) #映射X轴偏移值 move_x=Center_x+offsetX #水平球在X坐标上的移动 move_y=Center_y+offsetY #水平球在Y坐标上的移动 oled.circle(Center_x,Center_y,6,1) #画中心固定圆:空心 oled.fill_circle(move_x,move_y,4,1) #画移动的水平球:实心 oled.DispChar("%0.1f,%0.1f" %(x,y),85,0) #显示水平球在X、Y轴的加速度值 if offsetX==0 and offsetY==0: rgb.fill((0,10,0)) #水平球在中心位置亮绿灯,亮度为10 rgb.write() else: rgb.fill((0,0,0)) #水平球不在中心位置灭灯 rgb.write() oled.show() oled.fill(0)
当检测到掌控板在X轴和Y轴方向倾斜时(范围-1g 至+1g),将X轴、Y轴的偏移值也就是加速度值(范围-1至1)分别映射在以设定的中心点为原点的X坐标上的Y坐标(范围32至-32)、X坐标(范围-64至64)上:
if y<=1 and y>=-1: offsetX=int(numberMap(y,1,-1,-64,64)) if x<=1 and x>=-1: offsetY=int(numberMap(x,1,-1,32,-32))
注解:
numberMap(inputNum, bMin, bMax, cMin, cMax) 是映射函数,``inputNum`` 为需要映射的变量,``bMin`` 为需要映射的最小值,``bMax`` 为需要映射的最大值,``cMin`` 为映射的最小值,``cMax`` 为映射的最大值。
水平球在X、Y坐标上的移动:水平球在坐标上的移动 = 中心点位置 + 加速度的偏移值:
move_x=Center_x+offsetX move_y=Center_y+offsetY
如果水平球移动到中心位置,则亮绿灯,否则不亮灯:
if offsetX==0 and offsetY==0: rgb.fill((0,10,0)) #水平球在中心位置亮绿灯,亮度为10 rgb.write() else: rgb.fill((0,0,0)) #水平球不在中心位置灭灯 rgb.write()
计算掌控板倾斜的角度
通过测量由于重力引起的加速度,可以计算出设备相对于水平面的倾斜角# 通过y轴加速度求y轴与水平面倾斜角度 from mpython import* from math import acos,degrees while True: y=accelerometer.get_y() if y<=1 and y>=-1: rad_y=acos(y) deg_y=90-degrees(rad_y) oled.DispChar('%.2f°' %deg_y,50,25) oled.show() oled.fill(0)
使用前,导入mpython模块和math模块中acos函数、degrees函数:
from mpython import * from math import acos,degrees
获取X轴的加速度:
x = accelerometer.get_x()
假设掌控板参考水平面为桌面,掌控板倾斜过程中,Y轴与桌面是平行,其夹角不变(一直是0度),发生变化的是X轴与桌面的夹角以及Z轴与桌面的夹角,而且桌面与X轴Z轴夹角变化度数是一样的。为了方便分析,我们从Y轴的方向俯看下去,那么这个问题就会简化成只有X轴和Z轴的二维关系。假设某一时刻掌控板处于如下状态:
在这个图中,Y轴已经简化和坐标系的原点O重合在了一起。我们来看看如何计算出掌控板的倾斜角,也就是与桌面的夹角a。g是重力加速度,gx、gz分别是g在X轴和Z轴的分量。
由于重力加速度是垂直于水平面的,得到: 角a+角b=90度 X轴与Y轴是垂直关系,得到: 角c+角b=90度 因此: 角a=角c
根据反余弦定理,计算角b的弧度值::
rad_x=acos(x)
计算夹角的角度,即角a=角c=90度-角b::
deg_x=90-degrees(rad_x)
注解:
* acos() 函数为返回反余弦弧度值。 * degrees() 函数为将弧度转换为角度。
<< 上一篇
下一篇 >>
网友留言(0 条)