本发明实施例公开了一种机器人双臂自平衡方法及机器人,用于解决现有技术中服务机器人因承载重物或者遇到机体倾斜使得机器人不能保持双臂平衡而使双臂上的物体掉落而损坏,双臂上的物品安全得不到保证的技术问题.本发明实施例方法包括:通过控制机器人的手臂的电机转动角度及根据第一陀螺仪的倾斜角转动手掌调整手掌处于平衡状态;根据实时检测到的第一陀螺仪和第二陀螺仪的输出数据判断机器人的机体倾斜角是否有变化;若机器人的机体倾斜角有变化,计算机器人的机体的倾斜角,并根据倾斜角上下移动手臂或转动手掌.
发明专利
CN201710018629.2
2017.01.10
CN106737747A
2017-05-31
刘治 刘达才 章云
广东工业大学
B25J11/00(2006.01)I,B,B25,B25J,B25J11
B25J11/00(2006.01)I,B25J19/00(2006.01)I,B,B25,B25J,B25J11,B25J19,B25J11/00,B25J19/00
一种机器人双臂自平衡方法,其特征在于,包括:机器人,所述机器人的手臂包括可旋转的手掌、手肘和肩膀转动关节;所述手掌设置有第一陀螺仪,所述机器人底部设置有第二陀螺仪;方法步骤包括:通过控制所述机器人的手臂的电机转动角度及根据第一陀螺仪的倾斜角转动所述手掌调整所述手掌处于平衡状态;根据实时检测到的所述第一陀螺仪和所述第二陀螺仪的输出数据判断所述机器人的机体倾斜角是否有变化;若所述机器人的机体倾斜角有变化,计算所述机器人的机体的倾斜角,并根据所述倾斜角上下移动所述手臂或转动所述手掌.