买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

申请/专利权人：之江实验室

摘要：本发明公开了一种双足机器人足底受力状态检测系统及方法，包括双足机器人脚底，竖直方向力检测模块，水平方向力检测模块以及信号处理电路。竖直方向力检测模块采集所述的双足机器人脚底沿竖直方向上的受力状态数据，所述的水平方向力检测模块采集所述的双足机器人脚底沿水平方向上的受力状态数据，所述的信号处理电路负责处理所述的竖直方向力检测模块以及所述的水平方向力检测模块所产生的数据。

主权项：1.一种双足机器人足底受力状态检测方法，其特征在于，基于双足机器人足底受力状态检测系统，包括如下步骤：S1.确定双足机器人足底一点为原点O，沿着足底的前向方向为x轴，垂直于足底向上方向为z轴，根据右手定则确定y轴，据此，获取竖直方向力检测模块中阵列式压阻薄膜压力传感器的传感器单元中心点相对于原点O的坐标，记为xij,yij，获取所有水平方向力检测模块中水平方向力测量单元块中心点相对于原点O的坐标，记为ui′,vi′；S2.标定竖直方向力检测模块中阵列式压阻薄膜压力传感器的所有传感器单元，并获得力与电阻值关系曲线，记为：Fij＝fRij此处，Fij与Rij分别为竖直方向力检测模块中阵列式压阻薄膜压力传感器第i行第j列的传感器单元的受力大小以及电阻值；标定所有水平方向力检测模块中水平方向薄膜传感器阵列的薄膜压力传感器，并获得力与电阻值关系曲线，记为：Gi′h′＝gRi′0j′此处，Gi′j′与Ri′0j′分别为第i’个水平方向力检测模块中第j’个薄膜压力传感器的受力大小以及电阻值；S3.采集t时刻双足机器人脚底竖直方向受力情况，使用下式计算出竖直方向力检测模块中阵列式压阻薄膜压力传感器的传感器单元的电阻值为： 此处，Rij为竖直方向力检测模块中阵列式压阻薄膜压力传感器第i行第j列的传感器单元的电阻值，Rfi为连接第i行的反馈电阻的阻值，Voutij为该传感器单元的输出电压值，VCC为n选一多路选择器共同接线端的电压；采集t时刻双足机器人脚底水平方向受力情况，使用下式计算出水平方向力检测模块中薄膜压力传感器的电阻值为： 此处，Ri′0j′为所有水平方向力检测模块中水平方向薄膜传感器阵列的第i’行第j’列的薄膜压力传感器的电阻值，Rfti′为连接第i’行的反馈电阻的阻值，Vouti′0j′为该传感器单元的输出电压值，VDD为4选一多路选择器共同接线端的电压；S4.基于步骤S2～S3，获得竖直方向上各个传感器单元的受力数据Fij，和水平方向上各个薄膜压力传感器的受力数据Gi′h′；i∈[1,n]，j∈[1,m]；i′∈[1,s]，j′∈[1,4]；利用下式计算水平方向力检测模块沿X轴以及Y轴方向的水平方向力：δi′x＝Gi′a-Gi′bδi′y＝Gi′c-Gi′d此处，Gi′a,Gi′b分别表示第i′个水平方向力检测模块在x轴方向的两个薄膜压力传感器的受力值，Gi′c,Gi′d分别表示第i′个水平方向力检测模块在y轴方向的两个薄膜压力传感器的受力值；S5.根据步骤S1与S4中获得的坐标以及竖直方向受力数据，根据下式获得双足机器人脚底的零力矩点坐标： 此处，px与py代表零力矩点的坐标；S6.根据步骤S1、S4与S5获得零力矩点坐标处的水平方向力产生的力矩τz： 所述双足机器人足底受力状态检测系统，包括双足机器人脚底、竖直方向力检测模块、水平方向力检测模块以及信号处理电路；竖直方向力检测模块采集双足机器人脚底沿竖直方向上的受力状态数据；水平方向力检测模块采集双足机器人脚底沿水平方向上的受力状态数据；信号处理电路负责处理竖直方向力检测模块以及水平方向力检测模块所产生的数据；竖直方向力检测模块包括阵列式压阻薄膜压力传感器；所述阵列式压阻薄膜压力传感器具有m行n列共m×n个传感器单元；水平方向力检测模块包括水平方向力测量单元块、薄膜压力传感器；水平方向力测量单元块的外形为长方体；双足机器人脚底设置有凹腔，水平方向力测量单元块部分嵌入凹腔，水平方向力测量单元块的高度不小于凹腔的深度；凹腔的四个内壁分别设置一个薄膜压力传感器，薄膜压力传感器设置在水平方向力测量单元块与凹腔之间；双足机器人脚底至少设置一个水平方向力检测模块；所有水平方向力检测模块内设置的薄膜压力传感器组成一个s行4列的水平方向薄膜传感器阵列，s为水平方向力检测模块的数量。

全文数据：

权利要求：

百度查询： 之江实验室 一种双足机器人足底受力状态检测系统及方法