一种具有体感功能的助残机器人的制作方法

本实用新型属于机器人技术领域，具体涉及一种具有体感功能的助残机器人。

背景技术：

据统计，我国残疾人总数达8000万以上，其中，肢体残疾人数占比超过25％。肢体残疾，尤其是腿脚残疾的人，行动能力差或完全丧失行动能力。现有的助残设备，诸如拐杖、义肢等，虽能帮助腿脚残疾的人获得一定程度的行动能力，但需要使用者通过身体直接接触控制，耗费体力，如若操作不当，使用者很容易受伤。

技术实现要素：

本实用新型提出一种具有体感功能的助残机器人。

本实用新型所采用的方案为：

一种具有体感功能的助残机器人，包括电动小车、六自由度机械臂和主机端；

所述电动小车包括上下相对设置的底板和顶板，所述底板和所述顶板间通过若干支撑杆固连，所述底板下端面外缘沿着周向均匀固定三个编码直流电机，每一编码直流电机的输出轴均朝向外侧，且每一编码直流电机的输出轴端部均安装有麦克纳姆轮；所述六自由度机械臂安装在所述顶板上端面上，所述底板上端面固定有定位传感器、控制器、电源模块和用于采集场景图像数据的第一kinect体感摄像头，所述定位传感器、所述六自由度机械臂、所述第一kinect体感摄像头和三个编码直流电机分别与所述控制器相连，所述电源模块为所述助残机器人除所述主机端以外的部件供电；

所述主机端包括图形适配器、计算机和用于采集手臂关节图像数据的第二kinect体感摄像头，所述第二kinect体感摄像头、所述图形适配器和所述计算机依次相连，所述计算机与所述控制器通过无线方式信号连接。

进一步地，所述六自由度机械臂包括：第一大臂关节、第二大臂关节、第一小臂关节、第二小臂关节、腕关节和机械爪；

所述第一大臂关节包括第一舵机、第一舵机固定架、第一u型连接件和第一l型连接件，所述第一舵机固定架水平固定在所述顶板上端面中间位置，所述第一舵机安装在所述第一舵机固定架上，所述第一舵机的输出轴朝向右侧，所述第一舵机的输出轴端部安装有第一舵盘；所述第一u型连接件自上而下跨设在所述第一舵机上，所述第一u型连接件的一侧板与所述第一舵盘固定相连，另一侧板与所述第一舵机固定架转动连接；所述第一l型连接件固定在所述第一u型连接件顶部；

所述第二大臂关节包括第二舵机、第二舵机固定架、第二u型连接件和第二l型连接件；所述第二舵机固定架竖直固定在所述第一l型连接件上，所述第二舵机安装在所述第二舵机固定架上，所述第二舵机的输出轴朝向左侧，所述第二舵机的输出轴端部安装有第二舵盘；所述第二u型连接件自上而下跨设在所述第二舵机上，所述第二u型连接件的一侧板与所述第二舵盘固定相连，另一侧板与所述第二舵机固定架转动连接；所述第二l型连接件固定在所述第二u型连接件顶部；

所述第一小臂关节包括第三舵机、第三舵机固定架和第三l型连接件；所述第三舵机固定架横向固定在所述第二l型连接件上，所述第三舵机安装在所述第三舵机固定架上，所述第三舵机的输出轴朝上，所述第三舵机的输出轴端部安装有第三舵盘，所述第三l型连接件与所述第三舵盘固定相连；

所述第二小臂关节包括第四舵机、第四舵机固定架、第三u型连接件和第四l型连接件；所述第四舵机固定架竖直固定在所述第三l型连接件上，所述第四舵机安装在所述第四舵机固定架上，所述第四舵机的输出轴朝向右侧，所述第四舵机的输出轴端部安装有第四舵盘；所述第三u型连接件自上而下跨设在所述第四舵机上，所述第三u型连接件的一侧板与所述第四舵盘固定相连，另一侧板与所述第四舵机固定架转动连接；所述第四l型连接件固定在所述第三u型连接件顶部；

所述腕关节包括第五舵机、直角连接件、第一夹板和第二夹板；所述直角连接件与所述第四l型连接件固定连接，所述第五舵机固定在所述直角连接件上，所述第五舵机的输出轴朝上，所述第五舵机的输出轴端部安装有第一十字舵盘，所述第一夹板和所述第二夹板分别竖直固定在所述第一十字舵盘上，两夹板相对，且留有间隙；

所述机械爪包括机械爪固定板、第六舵机、左齿柄连接件、右齿柄连接件、左夹爪、右夹爪、第一连杆、第二连杆、第三连杆和第四连杆；

所述机械爪固定板底部竖直插接在所述两夹板间，并与所述两夹板固定连接；所述第六舵机固定安装在所述机械爪固定板背面，所述第六舵机的输出轴向前穿过所述机械爪固定板，所述第六舵机的输出轴端部安装有第二十字舵盘，所述右齿柄连接件的齿部与所述第二十字舵盘固定连接，所述左齿柄连接件的齿部与所述机械爪固定板通过第一销轴转动连接，所述右齿柄连接件的齿部和所述左齿柄连接件的齿部啮合；所述左夹爪的尾端与所述左齿柄连接件的柄部通过第二销轴转动连接，所述右夹爪的尾端与所述右齿柄连接件的柄部通过第三销轴转动连接；所述第一连杆和所述第二连杆各自的一端分别与所述左夹爪中间位置通过第四销轴转动连接，第一、第二连杆分别位于所述左夹爪前、后侧，所述第一连杆和所述第二连杆各自的另一端分别与所述机械爪固定板前部通过第五销轴转动连接；所述第三连杆和所述第四连杆各自的一端分别与所述右夹爪中间位置通过第六销轴转动连接，第三、第四连杆分别位于所述右夹爪前、后侧，所述第三连杆和所述第四连杆各自的另一端分别与所述机械爪固定板前部通过第七销轴转动连接；

第一、第二、第三、第四、第五、第六舵机分别与所述控制器相连。

进一步地，侧板与舵机固定架转动连接方式为：侧板与舵机固定架通过螺栓相连，螺栓上套有一轴承，侧板套在轴承上，舵机固定架和螺栓端部共同限制侧板作轴向移动。

进一步地，所述控制器包括stm32f103主控制器和与所述stm32f103主控制器相连的树莓派3b+，所述树莓派3b+集成有无线网卡，所述树莓派3b+与所述计算机通过tcp无线通信。

进一步地，所述电源模块为12v锂电池。

进一步地，所述底板、所述顶板和多个支撑杆均为亚克力材质。

本实用新型的有益效果在于：

本实用新型的助残机器人可通过体感功能，快速响应使用者手臂动作，实现物体抓取等操作。操作方便，使用者与机器人不直接接触，安全可靠。本实用新型的助残机器人可提高残疾人的生活便利度。

附图说明

图1为本实用新型的助残机器人的结构示意图；

图2为主机端的结构示意图；

图3为电动小车的结构示意图；

图4为第一大臂关节的结构示意图；

图5为第二大臂关节的结构示意图；

图6为第一小臂关节的结构示意图；

图7为第二小臂关节的结构示意图；

图8为腕关节的结构示意图；

图9为机械爪的结构示意图；

附图标记：1-电动小车，101-底板，102-顶板，103-支撑杆，104-编码直流电机，105-麦克纳姆轮；2-第一kinect体感摄像头，3-第一大臂关节，301-第一舵机，302-第一舵盘，303-第一舵机固定架，304-第一u型连接件，305-第一l型连接件；4-第二大臂关节，401-第二舵机，402-第二舵盘，403-第二舵机固定架，404-第二u型连接件，405-第二l型连接件；5-第一小臂关节，501-第三舵机，502-第三舵盘，503-第三舵机固定架，504-第三l型连接件；6-第二小臂关节，601-第四舵机，602-第四舵盘，603-第四舵机固定架，604-第三u型连接件，605-第四l型连接件；7-腕关节，701-第五舵机，702-直角连接件，703-第一十字舵盘，704-第一夹板，705-第二夹板；8-机械爪，801-机械爪固定板，802-第六舵机，803-左齿柄连接件，804-右齿柄连接件，805-第二十字舵盘，806-左夹爪，807-右夹爪，808-第一连杆，809-第二连杆，8010-第三连杆，8011-第四连杆；9-第二kinect体感摄像头，10-图形适配器，11-计算机。

具体实施方式

下面结合附图和具体的实施例对本实用新型的具有体感功能的助残机器人作进一步地详细说明。

如图1和图2所示的具有体感功能的助残机器人，包括电动小车1、六自由度机械臂和主机端。

参见图3，电动小车1包括上下相对设置的底板101和顶板102，底板101和顶板102通过若干支撑杆103固连，底板101下端面外缘沿着周向均匀固定三个编码直流电机104，每一编码直流电机104的输出轴均朝向外侧，且每一编码直流电机104的输出轴端部均安装有麦克纳姆轮105，底板101上位于每一麦克纳姆轮105位置均开设有相适配的缺口。编码直流电机104上设置编码盘，编码盘可读取电机转速，进而获得对应麦克纳姆轮105的运动速度。结合图1，六自由度机械臂安装在顶板102上端面上中间位置，底板101上端面固定有定位传感器、控制器、电源模块和用于采集场景图像数据的第一kinect体感摄像头2，定位传感器、六自由度机械臂、第一kinect体感摄像头2和三个编码直流电机104分别与控制器相连，电源模块为助残机器人除主机端以外的部件供电。

主机端包括图形适配器10、计算机11和用于采集手臂关节图像数据的第二kinect体感摄像头9，第二kinect体感摄像头9、图形适配器10和计算机11依次相连，计算机11与控制器通过无线方式信号连接。第二kinect体感摄像头9、图形适配器10和计算机11均通过电源适配器连接220v市电进行供电。

具体地，参见图1，六自由度机械臂包括：第一大臂关节3、第二大臂关节4、第一小臂关节5、第二小臂关节6、腕关节7和机械爪8。

如图4所示，第一大臂关节3包括第一舵机301、第一舵机固定架303、第一u型连接件304和第一l型连接件305，第一舵机固定架303通过螺栓水平固定在顶板102上端面中间位置，第一舵机301通过螺栓安装在第一舵机固定架303上，第一舵机301的输出轴朝向右侧(参见图1)，第一舵机301的输出轴端部安装有第一舵盘302。第一u型连接件304自上而下跨设在第一舵机301上，第一u型连接件304的一侧板与第一舵盘302通过螺栓固定相连，另一侧板与第一舵机固定架303转动连接。第一l型连接件305通过螺栓固定在第一u型连接件304顶部。

如图5所示，第二大臂关节4包括第二舵机401、第二舵机固定架403、第二u型连接件404和第二l型连接件405。第二舵机固定架403通过螺栓竖直固定在第一l型连接件305上，第二舵机401通过螺栓安装在第二舵机固定架403上，第二舵机401的输出轴朝向左侧(参见图1)，第二舵机401的输出轴端部安装有第二舵盘402。第二u型连接件404自上而下跨设在第二舵机401上，第二u型连接件404的一侧板与第二舵盘402通过螺栓固定相连，另一侧板与第二舵机固定架403转动连接。第二l型连接件405通过螺栓固定在第二u型连接件404顶部。

如图6所示，第一小臂关节5包括第三舵机501、第三舵机固定架503和第三l型连接件504。第三舵机固定架503通过螺栓横向固定在第二l型连接件405上，第三舵机501通过螺栓安装在第三舵机固定架503上，第三舵机501的输出轴朝上(参见图1)，第三舵机501的输出轴端部安装有第三舵盘502，第三l型连接件504与第三舵盘502通过螺栓固定相连。

如图7所示，第二小臂关节6包括第四舵机601、第四舵机固定架603、第三u型连接件604和第四l型连接件605。第四舵机固定架603通过螺栓竖直固定在第三l型连接件504上，第四舵机601通过螺栓安装在第四舵机固定架603上，第四舵机601的输出轴朝向右侧(参见图1)，第四舵机601的输出轴端部安装有第四舵盘602。第三u型连接件604自上而下跨设在第四舵机601上，第三u型连接件604的一侧板与第四舵盘602通过螺栓固定相连，另一侧板与第四舵机固定架603转动连接。第四l型连接件605通过螺栓固定在第三u型连接件604顶部。

如图8所示，腕关节7包括第五舵机701、直角连接件702、第一夹板704和第二夹板705。直角连接件702与第四l型连接件605固定连接，第五舵机701通过螺栓固定在直角连接件702上，第五舵机701的输出轴朝上(参见图1)，第五舵机701的输出轴端部安装有第一十字舵盘703，第一夹板704和第二夹板705分别通过螺钉竖直固定在第一十字舵盘703上，两夹板相对，且留有间隙。

如图9所示，机械爪8包括机械爪固定板801、第六舵机802、左齿柄连接件803、右齿柄连接件804、左夹爪806、右夹爪807、第一连杆808、第二连杆809、第三连杆8010和第四连杆8011。

机械爪固定板801底部竖直插接在两夹板间(参见图1)，并与两夹板通过螺栓固定连接。第六舵机802通过螺钉固定安装在机械爪固定板801背面，第六舵机802的输出轴向前穿过机械爪固定板801，第六舵机802的输出轴端部安装有第二十字舵盘805，右齿柄连接件804的齿部与第二十字舵盘805通过螺钉固定连接，左齿柄连接件803的齿部与机械爪固定板801通过第一销轴转动连接，右齿柄连接件804的齿部和左齿柄连接件803的齿部啮合。左夹爪806的尾端与左齿柄连接件803的柄部通过第二销轴转动连接，右夹爪807的尾端与右齿柄连接件804的柄部通过第三销轴转动连接。第一连杆808和第二连杆809各自的一端分别与左夹爪806中间位置通过第四销轴转动连接，第一、第二连杆分别位于左夹爪806前、后侧，第一连杆808和第二连杆809各自的另一端分别与机械爪固定板801前部通过第五销轴转动连接。第三连杆8010和第四连杆8011各自的一端分别与右夹爪807中间位置通过第六销轴转动连接，第三、第四连杆分别位于右夹爪807前、后侧，第三连杆8010和第四连杆8011各自的另一端分别与机械爪固定板801前部通过第七销轴转动连接。

第一、第二、第三、第四、第五、第六舵机分别与控制器相连。

本实施例中，底板101、顶板102和多个支撑杆103均为亚克力材质。

侧板与舵机固定架转动连接的方式为：侧板与舵机固定架通过螺栓相连，螺栓上套有一轴承，侧板套在轴承上，舵机固定架和螺栓端部共同限制侧板作轴向移动。

控制器包括stm32f103主控制器和与stm32f103主控制器相连的树莓派3b+，树莓派3b+采用的cpu型号为bcm2837b0，树莓派3b+集成有无线网卡，可与计算机11通过tcp通信。电源模块为12v锂电池，12v锂电池直接为第一kinect体感摄像头2、各舵机和各电机供电。12v锂电池为控制器供电时，通过电压转换器转为5v电压进行供电。

本实用新型的助残机器人的使用方法为：

六自由度机械臂预先建模并存储于计算机11中，建模方法采用d-h参数法。助残机器人的控制方式为体感控制：首先，助残机器人旋转一周(stm32f103主控制器控制三个编码直流电机104同向转动)，过程中，第一kinect体感摄像头2采集场景图像数据，场景图像数据发送至计算机11中生成三维场景模型。接着，使用者在计算机11中输入目标点位置，该目标点位置数据传输至树莓派3b+，树莓派3b+通过slam算法，根据目标点位置和定位传感器获得的当前位置自动规划移动路径，避开障碍物，stm32f103主控制器控制助残机器人按照规划的路径移动到目标点位置(直线移动通过一编码直流电机104不动，另两编码直流电机104转动方向相反实现)，定位传感器可精确判别助残机器人是否到达指定的目标点位置。最后，使用者手臂动作，第二kinect体感摄像头9实时采集手臂关节图像并通过图形适配器10传输至计算机11，计算机11对手臂关节图像进行正向运动学和逆向运动学求解，得到对应于六自由度机械臂各关节的转动角度，并生成转角数据包，手掌张合的数据对应于机械爪8的开合度。转角数据包发送至树莓派3b+，stm32f103主控制器根据转角数据包控制各舵机转动，实现物体抓取等操作。

以上所述的仅是本实用新型的优选实施方式，应当指出，对于本领域的普通技术人员来说，在不脱离本实用新型创造构思的前提下，还可以做出若干变形和改进，这些都属于本实用新型的保护范围。