一个超酷的开源uHand2.0机械手掌项目

简介: 一个超酷的开源uHand2.0机械手掌项目

uHand2.0是深圳乐幻索尔公司开源的一款机械手掌,它长下面这个样子:

1、uHand2.0外观图

640.jpg

之前在公众号就分享过视频:


学习嵌入式可以带娃,不信你们看

2、uHand2.0硬件原理图

看似整体非常复杂(主要是结构),但其实硬件(指电路部分)、软件一点都不复杂,我们来看下控制机械手掌的电路原理图,控制部分的芯片采用的STM32F103RBT6

640.png

底板对接的原理图如下:

640.png

640.png

可以看到,以上这些都是我们熟悉的硬件接口,包含LED、蜂鸣器、按键、SPI FLASH、舵机、PS2,控制机械手掌根据官方提供的文档主要四种方式:


  • 1、通过PC串口连接C#上位机控制机械手掌
  • 2、通过体感手套蓝牙模块连接机械手掌进行控制
  • 3、通过Android手机APP控制机械手掌
  • 4、通过PS2手柄控制机械手掌


不管是通过什么方式去控制手掌运动,能有一套公有的通信协议那就再好不过了,那么uHand2.0对这一套协议也是完全开源的,我们来阅读一些基础协议,以便于我们后面入门各个软件程序。

3、uHand2.0通信协议

640.png

其中,通信分为两种:


  • 1、用户主动通过C#上位机、PS2、PC、APP主动给控制板发送数据
  • 2、控制板主动给C#上位机、PS2、PC、APP发送数据


具体协议内容请公众号后台回复:uHand获取开源机械手掌资料,这里就不细说了。

4、uHand2.0底板控制部分

官方给出的有两种控制方式,一种是基于STM32、还有一种是基于51单片机,不管是什么平台控制,软件逻辑其实都是大同小异,我们就拿常用的STM32软件进行分析吧。


先看下代码的整体框架:

int main(void)
{
 SystemInit();     //系统时钟初始化为72M   SYSCLK_FREQ_72MHz
 InitDelay(72);      //延时初始化
    //设置NVIC中断分组2:2位抢占优先级,2位响应优先级
 NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); 
 InitPWM();
 InitTimer2();//用于产生100us的定时中断
 InitUart1();//用于与PC端进行通信
 InitUart3();//外接模块的串口
 InitADC();
 InitLED();
 InitKey();
 InitBuzzer();
 InitPS2();//PS2游戏手柄接收器初始化
 InitFlash();
 InitMemory();
 InitBusServoCtrl();
 LED = LED_ON;
 BusServoCtrl(1,SERVO_MOVE_TIME_WRITE,500,1000);
 BusServoCtrl(2,SERVO_MOVE_TIME_WRITE,500,1000);
 BusServoCtrl(3,SERVO_MOVE_TIME_WRITE,500,1000);
 BusServoCtrl(4,SERVO_MOVE_TIME_WRITE,500,1000);
 BusServoCtrl(5,SERVO_MOVE_TIME_WRITE,500,1000);
 BusServoCtrl(6,SERVO_MOVE_TIME_WRITE,500,1000);
 while(1)
 {
  TaskRun();
 }
}

由于机械手掌采用是总线舵机,其实它就是数字舵机,是基于串行总线开发的,通常采用一根线就可以完成发送和接收的操作,十分方便,详情可以参考开源机械手掌的资料,这里我们看一下BusServoCtrl这个函数实现的功能:

void BusServoCtrl(uint8 id,uint8 cmd,uint16 prm1,uint16 prm2)
{
 uint32 i;
 uint8 tx[20];
 uint8 datalLen = 4;
 uint32 checkSum = 0;
 switch(cmd)
 {
 case SERVO_MOVE_TIME_WRITE:
  datalLen = SERVO_MOVE_TIME_DATA_LEN;
  break;
 }
 tx[0] = 0x55;
 tx[1] = 0x55;
 tx[2] = id;
 tx[3] = datalLen;
 tx[4] = cmd;
 tx[5] = prm1;
 tx[6] = prm1 >> 8;
 tx[7] = prm2;
 tx[8] = prm2 >> 8;
 for(i = 2; i <= datalLen + 1; i++)
 {
  checkSum += tx[i];
 }
 tx[datalLen + 2] = ~checkSum;
 UART_TX_ENABLE();
 USART2SendDataPacket(tx,datalLen + 3);
}

该函数的第一个参数为舵机id,第二个参数为指令,第三、四个参数为指令的参数,例如要控制数字电机转动,则需要设置prm1和prm2值,以让舵机能够在具体的时间内转动到具体的位置,最终通过串口将协议数据发送到数字舵机,这时候舵机接收到指令则会响应具体的操作,这个函数是贯穿整个机械手掌运动的核心函数。


如果通过C#上位机、APP控制机械手掌,那么也是一样的,C#上位机发送给控制板的USART1串口,我们重点看下USART1的串口中断服务函数的实现:

void USART1_IRQHandler(void)
{
    uint8 i;
    uint8 rxBuf;
    static uint8 startCodeSum = 0;
    static bool fFrameStart = FALSE;
    static uint8 messageLength = 0;
    static uint8 messageLengthSum = 2;
    if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET)
    {
        rxBuf = USART_ReceiveData(USART1);//(USART1->DR); //读取接收到的数据
        if(!fFrameStart)
        {
            if(rxBuf == 0x55)
            {
                startCodeSum++;
                if(startCodeSum == 2)
                {
                    startCodeSum = 0;
                    fFrameStart = TRUE;
                    messageLength = 1;
                }
            }
            else
            {
                fFrameStart = FALSE;
                messageLength = 0;
                startCodeSum = 0;
            }
        }
        if(fFrameStart)
        {
            Uart1RxBuffer[messageLength] = rxBuf;
            if(messageLength == 2)
            {
                messageLengthSum = Uart1RxBuffer[messageLength];
                if(messageLengthSum < 2)// || messageLengthSum > 30
                {
                    messageLengthSum = 2;
                    fFrameStart = FALSE;
                }
            }
            messageLength++;
            if(messageLength == messageLengthSum + 2)
            {
                if(fUartRxComplete == FALSE)
                {
                    fUartRxComplete = TRUE;
                    for(i = 0; i < messageLength; i++)
                    {
                        UartRxBuffer[i] = Uart1RxBuffer[i];
                    }
                }
                fFrameStart = FALSE;
            }
        }
    }
}

中断服务函数实现的功能就是将上位机、APP、PS2所发送的数据根据第三小节提到的协议格式转换成控制串口舵机的指令,这个过程是在TaskRun函数实现的,由于代码过于冗长,这里就不放出来了,感兴趣可以自行下载研究。另外,该代码的优化空间很大,有些部分写得不是太合理。

5、uHand2.0开源上位机

上位机采用的是C# 微软WPF框架开发,通过PC串口与机械手掌进行通信。

5.1、分析代码

当调整拖动杆时,调用anleChangeHandler方法:

private void angleChangeHandler(Object sender, RoutedEventArgs e)
{
     //手动拖动滑竿的时候才触发,其他情况引起的变化屏蔽
     if (needSendAngelChangeFlag)
     {
        int id = Convert.ToInt32((e.OriginalSource as ServoView).ServoId);
        int angle = (e.OriginalSource as ServoView).CurAngle;
        sendAngleCmd(id, angle);
     }
}

该方法首先会先确定当时控制的是哪个ID的拖杆,调整的数值是多少,最终调用sendAngleCmd方法:

//发送拖到滑竿引起的角度变化设置命令
private void sendAngleCmd(int id, int value)
{
    UInt16[] dataSend = new UInt16[MAX_ARGS_LENTH];
    for (int i = 0; i < MAX_ARGS_LENTH; i++)
    {
        dataSend[i] = UNDEFINECMD;
    }
    dataSend[0] = 1;
    dataSend[1] = 0;
    dataSend[2] = 0;
    dataSend[3] = (byte)id;
    dataSend[4] = (byte)(value & 0x00ff);
    dataSend[5] = (byte)(value >> 8);
    makeAndSendCmd(CMD_MULT_SERVO_MOVE, dataSend);
}

UNDEFINECMDpublic const UInt16 UNDEFINECMD = 0xFFFF;表示命令buffer默认参数。


MAX_ARGS_LENTHpublic const int MAX_ARGS_LENTH = 25;表示最大的命令长度


最后通过调用makeAndSendCmd将指令打包成为标准的通信协议包,通过串口发送给控制板,进而控制机械手掌运动。

//处理参数转换成标准命令协议格式然后发送
private void makeAndSendCmd(int cmdType, UInt16[] args)
{
    //sendingData = true;
    byte[] dataSend = new byte[50];
    byte lenth;
    dataSend[0] = 0x55;
    dataSend[1] = 0x55;
    dataSend[3] = (byte)cmdType;
    int i = 0;
    while (i <= MAX_ARGS_LENTH && args[i] != UNDEFINECMD)
    {
        dataSend[4 + i] = (byte)args[i];
        i++;
    }
    lenth = (byte)(i + 2);
    //填入长度信息
    dataSend[2] = lenth;
    WriteData(dataSend, lenth + 2);
}

那么其它几种控制方式也就大同小异了。获取所有开源资料请公众号后台回复:uHand获取开源机械手掌资料。


搞懂了机械手掌的基本原理,那么后面要实现一些非常酷的项目就很容易啦,比如机械手掌控制小车等等,敬请期待!

往期精彩

一些实用的C语言小技巧


由static来谈谈模块封装


C语言常用的一些转换工具函数收集


结构体对齐原则在自定义协议解析时的妙用之法

目录
相关文章
|
15天前
|
存储 数据可视化 项目管理
有哪些“极简风”页面设计的办公协同工具?再不怕眼花缭乱啦!
在快节奏的现代职场中,极简风页面设计的协同工具成为提升工作效率的重要手段。本文介绍了10款极简风设计的办公协同工具,包括板栗看板、Notion、Trello、Slack、Asana、Figma、Invision、Moqups、Coda和Dropbox Paper。这些工具不仅界面简洁直观,功能强大,还能帮助团队高效协作,让工作更加井然有序。
84 43
有哪些“极简风”页面设计的办公协同工具?再不怕眼花缭乱啦!
|
Web App开发 前端开发 数据安全/隐私保护
|
5月前
|
前端开发 JavaScript Java
计算机Java项目|热门网游推荐网站的设计与开发
计算机Java项目|热门网游推荐网站的设计与开发
计算机Java项目|热门网游推荐网站的设计与开发
|
23天前
|
监控 数据可视化
搬运5款精致小巧的免费软件
今天分享5款超实用的小工具,包括数据可视化工具Chartistic、网速监控软件Global Speed、微信空号检测软件燃精灵、PDF编辑工具Drawboard PDF和文件搜索工具闪电搜索。这些小巧精致的免费软件能够有效提升工作和生活的效率。
30 1
|
1月前
|
编解码 数据可视化 小程序
分享5款堪称神器的软件
本文推荐了五款超实用的效率软件:1. Launchy——快速启动应用程序的开源工具;2. MindMapper——结构化呈现创意与信息的思维导图软件;3. 3171.cn——集合多种在线工具的全能平台;4. VidJuice UniTube——支持多平台高清视频下载的利器;5. Shotcut——具备多轨道处理与色彩校正功能的开源视频编辑器。这些工具旨在提升工作与学习效率,值得尝试。
41 1
|
4月前
|
算法 数据处理 开发者
LabVIEW开发为何仿制(致敬)经典成熟软件
LabVIEW开发为何仿制(致敬)经典成熟软件
31 2
|
6月前
|
编解码 数据可视化 Linux
搬运5款小众软件,知道的人少,但棒!
今天推荐5款十分小众的软件,知道的人不多,但是每个都是非常非常好用的,有兴趣的小伙伴可以自行搜索下载。
60 0
|
物联网 芯片 SoC
聊聊身边的嵌入式,自拍神器自拍杆
聊聊身边的嵌入式,自拍神器自拍杆
|
存储 人工智能 算法
MATIC马蹄链佛萨奇2.0系统源码搭建|现成案例|成熟技术
function _setImplementation(address newImplementation)internal{
|
Windows
分享五款小巧好用的绿色软件
电脑上的各类软件有很多,除了那些常见的大众化软件,还有很多不为人知的小众软件,专注于实用功能,简洁干净、功能强悍。
189 1
分享五款小巧好用的绿色软件