一个超酷的开源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语言常用的一些转换工具函数收集


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

目录
相关文章
|
存储 缓存 IDE
VirtualBox实现共享剪贴板
VirtualBox实现共享剪贴板
650 0
|
Linux API C语言
设备树知识小全(十):由设备树引发的BSP和驱动变更
设备树知识小全(十):由设备树引发的BSP和驱动变更
206 0
|
8月前
|
XML JSON 前端开发
HTTP协议,Content-Type格式介绍篇
通过理解和正确使用Content-Type头字段,可以确保数据在网络上传输时的正确性和高效性,提升网络应用的可靠性和用户体验。
720 25
|
9月前
|
IDE 编译器 开发工具
【C语言】全面系统讲解 `#pragma` 指令:从基本用法到高级应用
在本文中,我们系统地讲解了常见的 `#pragma` 指令,包括其基本用法、编译器支持情况、示例代码以及与传统方法的对比。`#pragma` 指令是一个强大的工具,可以帮助开发者精细控制编译器的行为,优化代码性能,避免错误,并确保跨平台兼容性。然而,使用这些指令时需要特别注意编译器的支持情况,因为并非所有的 `#pragma` 指令都能在所有编译器中得到支持。
769 41
【C语言】全面系统讲解 `#pragma` 指令:从基本用法到高级应用
|
数据采集 Web App开发 JavaScript
Puppeteer的高级用法:如何在Node.js中实现复杂的Web Scraping
随着互联网的发展,网页数据抓取已成为数据分析和市场调研的关键手段。Puppeteer是一款由Google开发的无头浏览器工具,可在Node.js环境中模拟用户行为,高效抓取网页数据。本文将介绍如何利用Puppeteer的高级功能,通过设置代理IP、User-Agent和Cookies等技术,实现复杂的Web Scraping任务,并提供示例代码,展示如何使用亿牛云的爬虫代理来提高爬虫的成功率。通过合理配置这些参数,开发者可以有效规避目标网站的反爬机制,提升数据抓取效率。
866 4
Puppeteer的高级用法:如何在Node.js中实现复杂的Web Scraping
|
8月前
|
数据可视化 IDE 开发工具
大模型编程(5)在线实战编码 - 纯免费
最近发现阿里云有许多实用资源,特别是提供Jupyter Notebook在线体验。Jupyter Notebook是一种互动计算环境,支持实时代码执行、可视化和文本说明等,方便用户创建和共享文档。通过这个平台,你可以直接在文档中运行代码,无需频繁切换命令行或IDE,极大提升了学习和开发效率。只需设置自己的API-key,即可开始动手实践。此外,阿里云的PAI平台也提供了类似的功能。
150 36
|
12月前
|
机器学习/深度学习 算法 计算机视觉
深度学习之图像修复算法
基于深度学习的图像修复算法旨在通过学习和生成模型来填补图像中的缺失或损坏部分。
455 7
【Vscode+Latex】Mac 系统Vscode的LaTeX中插入参考文献
在Mac系统下的VSCode环境中配置LaTeX工作流以便插入和引用参考文献的详细步骤。
790 0
|
算法 PyTorch 算法框架/工具
论文解读:LaMa:Resolution-robust Large Mask Inpainting with Fourier Convolutions
论文解读:LaMa:Resolution-robust Large Mask Inpainting with Fourier Convolutions
1256 0
|
编解码 Linux API
【Camera基础(一)】Camera摄像头工作原理及整机架构
【Camera基础(一)】Camera摄像头工作原理及整机架构