论坛 › 机器人 › 现实版铁甲钢拳 3

nille 发表于 2014-8-22 11:57:22

现实版铁甲钢拳 3

本帖最后由 nille 于 2014-8-26 17:53 编辑

　　
　　在用手柄玩了一段时间格斗机器人之后，制作过程可以回顾前两期的制作内容——第一期、第二期，这次本人在控制器方面又进行了一次升级。不再使用类似游戏机的手柄，而是自制了一个臂带式体感交互控制器。


　　大家一定觉得这个名字太抽象了，具体的说就是用加速度传感器来获取手臂的姿态，然后通过无线的方式来控制机器人或者其他的东东。
　　我用到的器材如下表，

　　 参见图1：


图1 所用器材　　先来说说硬件的连接，首先将护膝带在左手手腕上，为什么选择一个护膝而不是直接用一个护腕呢，这是因为护膝内和手臂的空间比较大，制作起来比较方便。而如果是用护腕则是完全勒在手腕上的。　　将护膝带到虎口位置即可，并将虎口的位置缝合起来，使其更像一个手套。同时把Arduino控制板和加速度传感器缝在护膝上，如图2所示，加速度传感器的连接线从护膝内穿过。
图2 控制板和加速度传感器的固定
　　第2步，将Xbee传感器扩展板V5插在Arduino控制板上，同时将加速度传感器的连接线连接到A0、A1和A2上，分别对应X、Y、Z三个轴向，并且把Numchuck连接器用连接线连到传感器扩展板上，连接是要注意引脚的定义，连接器的d端对应A4，c端对应A5。如图3所示。
图3 传感器扩展板的连接


　　第3步，将电池盒连接在传感器扩展板的电源输入端，并把其固定在护膝内，手臂内侧。如图4所示。
图4 电池盒的固定
　　第4步，将之前遥控器内的DFduino wireless无线模块拆下并安装在传感器扩展板上。如图5所示。

图5 安装无线模块　
　　 最后将Wii的副手柄numchuck接上，并将其握在右手内。如图6所示，这样，我们的臂带式体感交互控制器硬件部分就算完成了。
　
图6 连接numchuck
　　接下来说说软件部分。这个遥控器的控制思路是这样的，当我水平伸出手臂时，机器人作出摆臂的动作，如图7所示；当我向前挥动手臂时，机器人做出打拳的动作，如图8所示。
图7 水平伸出手臂

图8 向前挥动手臂
　　 而机器人的移动依靠numchuck手柄上的摇杆，同时配合手柄上的Z键和C键完成机器人的移动。控制动作和机器人的动作对应关系如下表。　　Wii的副手柄numchuck的使用《无线电》杂志的2010年第12期和2012年第6期都有介绍过，这里就简单的说明一下。Arduino使用这个副手柄需要单独下载一个WiiChuck库文件，有了这个库文件，在代码中直接调用wii.getAccelAxisX()、wii.getAccelAxisY()之类的函数就可以直接获得摇杆的值、手柄内加速的的值以及按钮的值。这里我还要对C键和Z键作一个说明，我手上的这个numchuck手柄，当Z键和C键都没有按下时，两者返回的都是1；当按下C键时，C键返回值为0，Z键返回值为1；但当按下Z键时，两者返回的值都是0；当C键和Z键都按下时，Z键的返回值为0，C键的返回值为1。
　　这里着重的说一下MMA7361加速度传感器的使用，如图9所示。加速度传感器是一种能够测量加速力的电子传感器。通过测量由于重力引起的加速度，可以计算出设备相对于水平面的倾斜角度，分析出设备移动的方式。
图9 MMA7361加速度传感器
　　MMA7361加速度传感器基于Freescale（飞思卡尔）公司生产的微型电容式三轴加速度传感器MMA7361芯片。该芯片采用信号调理、单极低通滤波器和温度补偿技术，提供±1.5g／6g两个量程，用户可在这2个灵敏度中选择，该器件还带有低通滤波并已做0g补偿。　　传感器有3个模拟量的三芯接口，分别表示X、Y、Z三个轴的加速度值，同时预留排针焊接孔。前面已经说过，我们分别将X、Y、Z三个轴向的加速度值输出引脚连接到A0、A1和A2。

图10 静态加速度传感器输出值
　　我们使用的是1.5g的量程，上图中给出了静态加速度传感器几种状态下的各个轴向加速度的值，由于量程是从-1.5g到+1.5g，所以当加速度为0g时，引脚输出的电压大致为1.65V，再因为有重力的关系，所以方向向下的轴向上加速度值是1g（根据方向的不同可能是+1g或-1g）。我们可以通过如下的代码将传感器输出的模拟量值转换为电压值（以X轴为例）。
vol_x=analogRead(A0)*5.0/1024;
　　然后根据1.5g量程下的灵敏度——800mV/g，通过电压值换算出轴向上当前的加速度值，代码如下。
g_x =（vol_x-1.76)/0.8
　　但在实际的应用中，由于传感器的差异，当在0g是输出的电压值可能不是1.65V，所以在使用加速度传感器之前需要对其进行校准，以当前0g时输出的电压值作准。
　　但在这里不用这么麻烦，只需要通过判断返回的模拟量值是否在一个区间内就能够推断出传感器当前大致的姿态，进而发送命令控制机器人。

　　详细代码如下。

　　#include <stdlib.h>
　　#include "Wire.h"
　　#include "WiiChuck.h"
　　
　　WiiChuck wii = WiiChuck();
　　
　　int sensorAccelX,sensorAccelY,sensorAccelZ;
　　int sensorAccelWiiX,sensorAccelWiiY,sensorAccelWiiZ;
　　int sensorJoyX,sensorJoyY;
　　int buttonC,buttonZ;
　　
　　
　　void setup()
　　{
　　 wii.init();                                 //初始化Wii手柄
　　 Serial.begin(57600);
　　}
　　
　　void loop()
　　{
      //获取加速度传感器的模拟量值
　　sensorAccelX = analogRead(A0);
　　sensorAccelY = analogRead(A1);
　　sensorAccelZ = analogRead(A2);
　　
　　//获取Wii手柄的各个参数
　　if (true == wii.read())
　　{
　　    sensorAccelWiiX = wii.getAccelAxisX();
　　    sensorAccelWiiY = wii.getAccelAxisY();
　　    sensorAccelWiiZ = wii.getAccelAxisZ();
　　   
　　    sensorJoyX = wii.getJoyAxisX();
　　    sensorJoyY = wii.getJoyAxisY();
　　   
　　    buttonZ = wii.getButtonZ();
　　    buttonC = wii.getButtonC();
　　}
　　
　　
　　//通过各个参数值推断当前两手的姿态，进而控制机器人
　　
　　//在未按下Z和C键时通过摇杆控制机器人移动
　　if((buttonZ == 1) && (buttonC == 1))
　　{
　　    if(sensorJoyY > 200)
　　    {
　　      Serial.write(1);//向机器人发送1，机器人将做出前进的动作
　　    }
　　    else if((sensorJoyY < 76) && (sensorJoyY > 40))
　　    {
　　      Serial.write(2); //向机器人发送2，机器人将做出后退的动作
　　    }
　　   
　　    if((sensorJoyX < 76) && (sensorJoyX > 40))
　　    {
　　      Serial.write(15); //向机器人发送15，机器人将做出左转的动作
　　    }
　　    else if(sensorJoyX > 200)
　　    {
　　      Serial.write(14); //向机器人发送14，机器人将做出右转的动作
　　    }
　　}
　　   
　　//按下Z键时控制机器人的左右平移和蹲下起身
　　if(buttonZ == 0)
　　{
　　    if(sensorJoyY > 200)
　　    {
　　      Serial.write(13); //向机器人发送13，机器人将做出起身的动作
　　    }
　　    else if((sensorJoyY < 76) && (sensorJoyY > 40))
　　    {
　　      Serial.write(12); //向机器人发送12，机器人将做出蹲下的动作
　　    }
　　   
　　    if((sensorJoyX < 76) && (sensorJoyX > 40))
　　    {
　　      Serial.write(8); //向机器人发送8，机器人将做出左移的动作
　　    }
　　    else if(sensorJoyX > 200)
　　    {
　　      Serial.write(7); //向机器人发送7，机器人将做出右移的动作
　　    }
　　}
　　
　　
　　//按下C键时控制机器人在跌倒的情况下爬起来
　　if((buttonZ == 1) && (buttonC == 0))
　　{
　　    if(sensorJoyY > 200)
　　    {
　　      Serial.write(9); //向机器人发送9，机器人将从前爬起
　　    }
　　    else if((sensorJoyY < 76) && (sensorJoyY > 40))
　　    {
　　      Serial.write(16); //向机器人发送16，机器人将从后爬起
　　    }
　　}
　　
　　
　　//通过加速度传感器控制机器人左臂的动作
　　if(sensorAccelX > 500)
　　{
　　    Serial.write(4); //向机器人发送4，机器人将做出左摆的动作
　　}
　　if(sensorAccelZ > 450)
　　{
　　    Serial.write(6); //向机器人发送6，机器人将做出左拳的动作
　　}
　　
　　
　　//通过Wii手柄控制机器人右臂的动作
　　if(sensorAccelWiiY < 154)
　　{
　　    Serial.write(3); //向机器人发送3，机器人将做出右摆的动作
　　}
　　if(sensorAccelWiiX < 115)
　　{
　　    Serial.write(5); //向机器人发送5，机器人将做出右拳的动作
　　}

　　delay(200);
　　}To be continued...

static/image/hrline/5.gif
相关链接： 三轴加速度传感器，IO 传感器扩展板，电池盒，镍氢充电电池

nille 发表于 2014-8-27 18:20:33

lauren 发表于 2014-8-27 01:49
程老师求BOM的销售超链接。。。=。=

稍后在修改文章 加上超链接

Tar07 发表于 2014-8-24 23:08:18

厉害！@~！~~

sdxiaomuyu 发表于 2014-8-26 14:37:31

开眼界呀。

nille 发表于 2014-8-26 15:37:30

续：

现实版铁甲钢拳 4 ——语音控制器https://www.dfrobot.com.cn/commun ... viewthread&tid=2962

lauren 发表于 2014-8-27 01:48:45

程老师这个应用有点过分了。。。

lauren 发表于 2014-8-27 01:49:17

程老师求BOM的销售超链接。。。=。=

gaofei7439 发表于 2014-10-20 10:41:27

nille 发表于 2014-8-27 18:20
稍后在修改文章 加上超链接

你好，借鉴你的这很拉风的思路，我也在做一个自己玩的远程蓝牙控制机器人。有个问题点一直有疑问： 因为手势控制端（主设备）发送数据的速率比较快，而从设备接收到蓝牙数据后有一系列的动作，相当于从设备接收蓝牙数据后延时一段时间再接收串口缓冲区的数据，结果我读取的数据一直是在缓存区内排列等候的。（从设备我用的Mega2560，此控制板的Serial.flush（）清除串口数据指令已经没有原来的功能），所以一直在想：怎样处理才能使得从设备能否读取到当前主设备对应的蓝牙数据？谢谢 ，请指点一下吧！

nille 发表于 2014-10-20 11:01:39

gaofei7439 发表于 2014-10-20 10:41
你好，借鉴你的这很拉风的思路，我也在做一个自己玩的远程蓝牙控制机器人。有个问题点一直有疑问： 因为 ...

我的做法是每次都把串口中的数据读空，取最后的数据处理

查看完整版本: 现实版铁甲钢拳 3