CN114764241A - 运动状态的控制方法、装置、设备及可读存储介质 - Google Patents

运动状态的控制方法、装置、设备及可读存储介质 Download PDF

Info

Publication number
CN114764241A
CN114764241A CN202110049662.8A CN202110049662A CN114764241A CN 114764241 A CN114764241 A CN 114764241A CN 202110049662 A CN202110049662 A CN 202110049662A CN 114764241 A CN114764241 A CN 114764241A
Authority
CN
China
Prior art keywords
wheeled robot
state
matrix
determining
data
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Pending
Application number
CN202110049662.8A
Other languages
English (en)
Inventor
王帅
张竞帆
来杰
张东胜
陈科
郑宇�
张正友
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Tencent Technology Shenzhen Co Ltd
Original Assignee
Tencent Technology Shenzhen Co Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Tencent Technology Shenzhen Co Ltd filed Critical Tencent Technology Shenzhen Co Ltd
Priority to CN202110049662.8A priority Critical patent/CN114764241A/zh
Priority to EP22738964.0A priority patent/EP4246271A4/en
Priority to PCT/CN2022/071024 priority patent/WO2022152083A1/zh
Priority to JP2023521655A priority patent/JP7518975B2/ja
Publication of CN114764241A publication Critical patent/CN114764241A/zh
Priority to US17/966,027 priority patent/US20230168693A1/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0231Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
    • G05D1/0246Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means
    • G05D1/0251Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using a video camera in combination with image processing means extracting 3D information from a plurality of images taken from different locations, e.g. stereo vision
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0891Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for land vehicles
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J13/00Controls for manipulators
    • B25J13/08Controls for manipulators by means of sensing devices, e.g. viewing or touching devices
    • B25J13/085Force or torque sensors
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J19/00Accessories fitted to manipulators, e.g. for monitoring, for viewing; Safety devices combined with or specially adapted for use in connection with manipulators
    • B25J19/0008Balancing devices
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J5/00Manipulators mounted on wheels or on carriages
    • B25J5/007Manipulators mounted on wheels or on carriages mounted on wheels
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1633Programme controls characterised by the control loop compliant, force, torque control, e.g. combined with position control
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1628Programme controls characterised by the control loop
    • B25J9/1653Programme controls characterised by the control loop parameters identification, estimation, stiffness, accuracy, error analysis
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D57/00Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
    • B62D57/02Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
    • B62D57/028Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members having wheels and mechanical legs
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B62LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
    • B62DMOTOR VEHICLES; TRAILERS
    • B62D61/00Motor vehicles or trailers, characterised by the arrangement or number of wheels, not otherwise provided for, e.g. four wheels in diamond pattern
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0255Control of position or course in two dimensions specially adapted to land vehicles using acoustic signals, e.g. ultra-sonic singals
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0259Control of position or course in two dimensions specially adapted to land vehicles using magnetic or electromagnetic means
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0278Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using satellite positioning signals, e.g. GPS
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/028Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0276Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
    • G05D1/0285Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using signals transmitted via a public communication network, e.g. GSM network

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Remote Sensing (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Automation & Control Theory (AREA)
  • General Physics & Mathematics (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Robotics (AREA)
  • Combustion & Propulsion (AREA)
  • Electromagnetism (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Transportation (AREA)
  • Chemical & Material Sciences (AREA)
  • Human Computer Interaction (AREA)
  • Multimedia (AREA)
  • Acoustics & Sound (AREA)
  • Manipulator (AREA)
  • Motorcycle And Bicycle Frame (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本申请公开了一种运动状态的控制方法、装置、设备及可读存储介质,涉及机器人控制领域。该方法包括:获取基础数据和运动状态数据,所述基础数据用于表示所述轮式机器人的结构特征,所述运动状态数据用于表示所述轮式机器人的运动特征;基于所述基础数据和所述运动状态数据确定所述轮式机器人的状态矩阵,所述状态矩阵与所述轮式机器人的干扰参数相关,所述干扰参数对应于所述轮式机器人的平衡误差;基于所述状态矩阵确定对所述轮式机器人进行控制的力矩;以所述力矩控制所述轮式机器人处于静止站定状态。

Description

运动状态的控制方法、装置、设备及可读存储介质
技术领域
本申请实施例涉及机器人控制领域,特别涉及一种运动状态的控制方法、 装置、设备及可读存储介质。
背景技术
轮式机器人是一种通过轮结构对机器人主体进行运动控制的机器人结构, 由于轮式机器人与地面的接触点仅包括车轮与地面的接触点,在轮式结构排布 本身不稳定的情况下,存在平衡控制的问题。相关技术中,通常使用的是传统 的线性化模型进行控制。
然而,相关技术中并未考虑到实际中的轮式机器人与理想化的模型有着物 理上的区别。由于安装的失误或者模型近似,实际中的平衡点可能与理想模型 中的平衡点存在差距,导致平衡控制所需的轮子旋转力矩不同。故,通过上述 方式无法对轮式机器人的平衡进行稳定的控制,存在稳定性较差的问题。
发明内容
本申请实施例提供了一种运动状态的控制方法、装置、设备及可读存储介 质,能够提高对轮腿式机器人的控制稳定性和准确率。所述技术方案如下:
一方面,提供了一种运动状态的控制方法,应用于轮式机器人中,所述方 法包括:
获取基础数据和运动状态数据,所述基础数据用于表示所述轮式机器人的 结构特征,所述运动状态数据用于表示所述轮式机器人的运动特征;
基于所述基础数据和所述运动状态数据确定所述轮式机器人的状态矩阵, 所述状态矩阵与所述轮式机器人的干扰参数相关,所述干扰参数对应于所述轮 式机器人的平衡误差;
基于所述状态矩阵确定对所述轮式机器人进行控制的力矩;
以所述力矩控制所述轮式机器人处于静止站定状态。
另一方面,提供了一种用于控制轮式机器人的运动状态的控制装置,所述 装置包括:
获取模块,用于获取基础数据和运动状态数据,所述基础数据用于表示所 述轮式机器人的结构特征,所述运动状态数据用于表示所述轮式机器人的运动 特征;
确定模块,用于基于所述基础数据和所述运动状态数据确定所述轮式机器 人的状态矩阵,所述状态矩阵与所述轮式机器人的干扰参数相关,所述干扰参 数对应于所述轮式机器人的平衡误差;
所述确定模块,还用于基于所述状态矩阵确定对所述轮式机器人进行控制 的力矩;
控制模块,用于以所述力矩控制所述轮式机器人处于静止站定状态。
另一方面,提供了一种轮式机器人,所述轮式机器人包括处理器和存储器, 所述存储器中存储有至少一段程序,所述至少一段程序由所述处理器加载并执 行以实现如上述本申请实施例中任一所述的运动状态的控制方法。
另一方面,提供了一种计算机可读存储介质,所述存储介质中存储有至少 一条指令、至少一段程序、代码集或指令集,所述至少一条指令、所述至少一 段程序、所述代码集或指令集由处理器加载并执行以实现如上述本申请实施例 中任一所述的运动状态的控制方法。
另一方面,提供了一种计算机程序产品或计算机程序,该计算机程序产品 或计算机程序包括计算机指令,该计算机指令存储在计算机可读存储介质中。 计算机设备的处理器从计算机可读存储介质读取该计算机指令,处理器执行该 计算机指令,使得该计算机设备执行上述实施例中任一所述的运动状态的控制 方法。
本申请实施例提供的技术方案带来的有益效果至少包括:
在确定对轮式机器人进行控制的力矩之前,首先确定体现机器人平衡误差 的状态矩阵,从而基于状态矩阵确定对轮式机器人进行控制的力矩,以该力矩 对轮式机器人的车轮进行控制,从而将轮式机器人控制处于静止站定状态,提 高了对存在平衡误差的轮式机器人的控制准确率。
附图说明
为了更清楚地说明本申请实施例中的技术方案,下面将对实施例描述中所 需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本申请 的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下, 还可以根据这些附图获得其他的附图。
图1是本申请一个示例性实施例提供的轮式机器人的结构示意图;
图2是本申请一个示例性实施例提供的轮式机器人在不同高度下的表现示 意图;
图3是本申请一个示例性实施例提供的运动状态的控制方法的流程图;
图4是本申请另一个示例性实施例提供的运动状态的控制方法的流程图;
图5是本申请一个示例性实施例提供的实验过程的轮式机器人表现示意图;
图6是本申请一个示例性实施例提供的对时间-俯仰角的测量状态与观测值 进行对比的曲线图;
图7是本申请一个示例性实施例提供的对时间-俯仰角速度的估计值与实际 值进行对比的曲线图;
图8是本申请一个示例性实施例提供的对时间-位移的估计值与实际值进行 对比的曲线图;
图9是本申请一个示例性实施例提供的对时间-线速度的估计值与实际值进 行对比的曲线图;
图10是本申请一个示例性实施例提供的时间-俯仰角误差值的曲线图;
图11是本申请一个示例性实施例提供的运动状态的控制装置的结构框图;
图12是本申请一个示例性实施例提供的终端的结构框图。
具体实施方式
为使本申请的目的、技术方案和优点更加清楚,下面将结合附图对本申请 实施方式作进一步地详细描述。
首先,对本申请实施例中所涉及的术语给出定义:
轮式机器人:轮式机器人是一种通过轮结构对机器人主体进行运动控制的 机器人结构,由于轮式机器人与地面的接触点仅包括车轮与地面的接触点,在 轮式结构排布本身不稳定的情况下,存在平衡控制的问题。
观测器:观测器是一种数学工具,可以通过迭代更新的方式,根据估计的 迭代值与实际的迭代值的误差,对自身估计的目标数学关系进行修正,并最终 得到相对准确的目标数学关系。在动力学领域,其可以通过观测物理量,迭代 更新观测器估计的动力学关系,并最终确定相对准确的动力学关系。
在本申请的本实施例中,以轮式机器人实现为轮式双足机器人为例进行说 明,也即,该轮式双足机器人中包括两个用于行动的车轮,两个车轮分别与腿 部结构连接,并由腿部结构与机器人主体连接,从而由两个车轮带动机器人主 体完成运动控制。但应当理解,本申请中的轮式机器人并不局限于上述结构。 凡是轮式机器人应当被理解为任何包含轮式结构的机器人。
示意性的,图1是本申请一个示例性实施例提供的轮式机器人的结构示意 图,如图1所示,该轮式机器人100包括主体部分110和轮腿部分120;
其中,主体部分110与轮腿部分120连接,轮腿部分120中包括2个车轮 121,和用于连接车轮121和主体部分110的腿部结构122,如图1所示,在该 轮式机器人100中共包括4个腿部结构122,该4个腿部结构122中的2个腿部 结构122分别与一个车轮121连接,示意性的,存在腿部结构A、腿部结构B、 腿部结构C和腿部结构D,则腿部结构A、腿部结构B与第一个车轮连接,腿 部结构C、腿部结构D与第二个车轮连接。其中,腿部结构A、腿部结构B与 第一个车轮,以及腿部结构C、腿部结构D与第二个车轮构成了轮式机器人的 两腿平面并联结构。并联型腿有五个转动关节,分别在横向和垂直方向上有两 个平移自由度。与串行机构相比,该并联机构具有结构紧凑、刚度高、承载能 力强的特点。因此,机器人可以跳得更高,灵活地克服障碍。
可选地,腿部结构122中包括小腿段1221和大腿段1222,小腿段1221和 大腿段1222之间通过转动关节连接,小腿段1221与车轮121之间也通过转动 关节连接。
主体部分110中分别对应4个腿部结构122设置有4组电机,该四组电机 用于控制腿部结构122的弯曲和伸直,在一些实施例中,腿部结构122与主体 部分110连接的一段通过转动关节相连,示意性的,如图1所示,则当电机驱 动转动关节进行顺时针转动时,即为控制腿部结构122趋向弯曲变化;而当电 机驱动转动关节进行逆时针转动时,即为控制腿部结构122趋向伸直变化。(其 中,2组腿部结构122通过转动关节进行驱动的方式相同或者不同)。也即顺逆 时针转动方式与弯曲伸直控制模式之间的关系相同或者不同。
其中,腿部结构122的弯曲和伸直(即小腿段1221和大腿段1222之间的 相对位置关系)用于控制轮式机器人100的高度,也即,当腿部结构122趋向 弯曲变化时,轮式机器人100的高度降低,而当腿部结构122趋向伸直变化时, 轮式机器人100的高度升高。示意性的,请参考图2,图1所示出的腿部结构 122为弯曲程度较大的情况,在该情况下,轮式机器人100的高度较低,而在图 2中,腿部结构122的弯曲程度相较图1的腿部结构122较小,在该弯曲程度下, 轮式机器人100的高度较高,在图1和图2的不同高度下,轮式机器人的平衡不同,导致在两种高度下的平衡控制力矩也不同。
车轮121为主动轮,也即,车轮121通过马达驱动后能够实现主动转动, 从而实现对轮式机器人100的运动状态控制,如:控制轮式机器人前进、控制 轮式机器人后退、控制轮式机器人转弯,或者控制轮式机器人静止站定。
基于轮式机器人100中主体部分110和轮腿部分120的结构,可以将该轮 式机器人100近似为一个小车倒立摆的结构。其中,轮式机器人100的身高即 对应倒立摆结构中的摆长。
该轮式机器人100的重量主要集中在主体部分110和车轮121,其中,主体 部分110的重量因素主要包括4台驱动腿部结构122的电机、微型计算机、电 路板、马达、电池等。
轮式机器人100的动力学模型可以通过如下公式一表达:
公式一:
Figure BDA0002898749910000051
Figure BDA0002898749910000052
其中,m用于指代轮式机器人车身,也即主体部分的质量,M用于指代轮式 机器人的车轮的质量,l为当前轮式机器人的身高,也即当前腿部结构下轮式机 器人的高度。x表示车轮的旋转距离,
Figure BDA0002898749910000053
表示车轮的旋转线速度,
Figure BDA0002898749910000054
表示旋转线速 度求导,即为旋转线加速度。θ表示轮式机器人的倾角,
Figure BDA0002898749910000055
表示轮式机器人的倾 角速度,
Figure BDA0002898749910000056
表示轮式机器人的倾角加速度。其中,以倾角θ为轮式机器人的俯仰 角为例进行说明。u即表示在轮式机器人上施加的推力,u和施加在车轮上的扭 矩之间存在对应的关系。
由于地面与轮式结构之间只有一个接触点(也即车轮与地面之间的接触点), 当多个轮式结构的排布并不稳定时,轮式机器人存在平衡控制的问题。由于机 器人的质量分布,平衡点往往不是近似模型预测的位置,因此,很难提供一个 平衡控制准确的参考位置。在这种情况下,输出调节可以在未知干扰下将系统 的输出调节到期望的状态。在本申请实施例中,提出了一种可以提高轮式机器 人的平衡控制效果的输出调节控制器。
图3是本申请一个实施例提供的运动状态的控制方法的流程图,该方法可 以实现在轮式机器人的微型处理器中。如图3所示,该方法包括:
步骤301:获取基础数据和运动状态数据,基础数据用于表示轮式机器人的 结构特征,运动状态数据用于表示轮式机器人的运动特征。
基础数据用于表示该轮式机器人的结构特征,结构特征包括机器人多个部 分的物理值。以图一中的轮式双足机器人100为例,结构特征包括:当前腿部 结构呈现的身高、主体部分质量、车轮质量、车轮半径、两个车轮之间的距离 等。结构特征也可以包括各部分间的联动结构。例如,以图一中的轮式双足机 器人100为例,当控制车轮顺时针转动从而向右运动时,主体部分和腿部结构 会通过联动方式相对车轮向左侧运动,这一联动结构也可以体现在基础数据中。 本申请并不对基础数据的具体形式或内容进行限定。
在一些实施例中,由于轮式机器人的基础结构为固定的,一部分基础数据 可以是预先设置好的。以图一中的轮式双足机器人100为例,比如主体部分的 第一质量数据,以及轮腿部分中车轮的第二质量数据,腿部结构所呈的角度与 身高之间的对应关系等等。在一些实施例中,一部分基础数据也可以是通过计 算得到的。以图一中的轮式双足机器人100为例,基础数据中的身高可以根据 腿部结构中小腿段和大腿段所呈现的角度根据对应关系计算得到。
运动状态数据用于表示轮式机器人的运动特征,可包括轮式机器人的倾角 数据和车轮的旋转数据,例如:倾角、倾角速度、车轮旋转距离(也即轮式机 器人的移动距离)、车轮旋转线速度等。本申请并不对运动状态数据的具体形式 或内容进行限定。
在一些实施例中,运动状态数据需要根据轮式机器人所处的运动状态检测 得到。例如,可以通过传感器对运动状态对应的倾角数据进行采集获取,并通 过电机读取车轮相关的数据。本申请不对运动状态数据获取的具体方式进行限 定。
步骤302:基于基础数据和运动状态数据确定轮式机器人的状态矩阵,该状 态矩阵与轮式机器人的干扰参数相关。
轮式机器人的状态矩阵是机器人的动力学方程的一种表现形式,可以通过 基础数据与运动状态数据进行确定。干扰参数对应于轮式机器人的平衡误差。 平衡误差是指实际重心点与预测重心点或者标定重心点之间的误差。在一些情 况下,轮式机器人自身组装本身存在误差,或者惯性测量单元的安装位姿存在 误差,或者由于各种各样的原因,导致实际重心的位置与设计或者标定的重心 位置不一致。因此本实施例对体现干扰参数的状态矩阵进行预测,可以方便对 轮式机器人的平衡进行更好的控制。本领域技术人员应当可以理解,在一些实 施例中,状态矩阵可以表示为相互联立的动力学方程组。
在一些实施例中,可以直接基于基础数据和运动状态数据得到实际的干扰 参数数值,再根据基础数据,运动状态数据,和干扰参数确定状态矩阵。
在另一些实施例中,可以将基础数据与运动状态数据结合,确定轮式机器 人的状态矩阵,从而将干扰参数内涵在状态矩阵中进行体现。
下文围绕图4揭示了示例性的具体实施方式,但本申请并不对确定该状态 矩阵的具体实现方式进行限定。
步骤303:基于该状态矩阵确定对轮式机器人进行控制的力矩。
基于状态矩阵,得到对轮式机器人进行控制的力矩,该力矩是基于控制轮 式机器人处于静止站定状态为目标而计算得到的力矩。
在一些实施例中,力矩是根据线性输出调节的计算方式得到的。下文围绕 图4揭示了示例性的具体实施方式,但本申请并不对确定控制力矩的具体方法 进行限定。
步骤304:以力矩控制轮式机器人处于静止站定状态。
在一些实施例中,将计算得到的力矩传输至电机,由电机对轮式机器人的 车轮进行电力控制,控制车轮以该力矩为目标进行转动,从而带动轮式机器人 的轮结构以及轮式机器人的主体部分趋于静止站定状态。本申请不对施加力矩 的实现方式进行限定,例如基于液压的驱动方式也应被认为包含在本申请中。
综上所述,本申请实施例提供的运动状态的控制方法,在确定对轮式机器 人进行控制的力矩之前,首先确定体现机器人平衡误差的状态矩阵,从而基于 状态矩阵确定对轮式机器人进行控制的力矩,以该力矩对轮式机器人的车轮进 行控制,从而将轮式机器人控制处于静止站定状态,提高了对存在平衡误差的 轮式机器人的控制准确率。
图4是本申请一些实施例的运动状态的控制方法的流程图,通过观测器对 体现干扰参数的状态矩阵进行估计,包括:
步骤401:获取基础数据和运动状态数据,基础数据用于表示轮式机器人的 结构特征,运动状态数据用于表示轮式机器人的运动特征。
此步骤的实施例与步骤301相似,在此省略。
步骤402:基于基础数据确定观测器。
观测器指的是可以通过观测物理量,迭代更新观测器估计的状态矩阵,并 最终确定状态矩阵的一类公式。
在一些实施例中,在基于基础数据确定观测器前,先设计观测器的形式。 观测器的形式可以是根据轮式机器人的状态矩阵的形式决定的。
下面以图一中的轮式双足机器人100为例给出状态矩阵的形式,应当理解 其他轮式机器人的状态矩阵可能有不同的形式,该轮式双足机器人100的状态 矩阵也可能近似或表示为其他形式,这些都属于本申请的公开范畴。
在一些实施例中,基于基础数据确定观测器中的矩阵参数,根据矩阵参数 获取直接用于确定状态矩阵的观测器。
轮式双足机器人100的运动学模型公式一在平衡点附近可以理想的近似表 示为线性的:
公式二:
Figure BDA0002898749910000081
其中
Figure BDA0002898749910000082
A和B为矩阵参数,
Figure BDA0002898749910000083
g表示重力加速度。
在一些实施例中,俯仰角的最大值是一个与数学模型相匹配的理想值。但 是由于上文已给出的原因,在另一些实施例中,惯性测量单元测量的θ会偏离真 实值。因此,考虑到轮式双足机器人100的平衡误差,即干扰参数,可以对测 量到的俯仰角进行校正:
公式三:
Figure BDA0002898749910000091
其中,
Figure BDA0002898749910000092
表示俯仰角的校正值,θ表示测量到的或者理论上的俯仰角,d表示 本申请实施例中的干扰参数,是一个常数。
基于该公式三,上述轮式双足机器人100的状态矩阵公式二可以转化为如 下公式四:
公式四:
Figure BDA0002898749910000093
其中,
Figure BDA0002898749910000094
用于表示动力学系统的状态,u是施加的力矩也即为动力学系统的 输入,
Figure BDA0002898749910000095
Figure BDA0002898749910000096
在一些实施例中,观测器中迭代值的选择是根据物理量的意义决定的。迭 代值的实际值可以通过测量确定,或根据测量到的物理量计算确定。因此,迭 代值形式的选择取决于可以测量到的物理量,或者说运动状态数据的形式或内 容。基于运动状态数据的内容,确定观测器中迭代值的形式。在一些实施例中, 该观测器可从下列物理量中选择迭代值:轮式机器人的倾角、倾角速度、车轮 旋转距离、车轮旋转线速度等。
例如,我们可以定义观测器中的迭代量ym为:
公式五:
Figure BDA0002898749910000097
其中,
Figure BDA0002898749910000098
也即,通过这个矩阵将上述
Figure BDA0002898749910000099
中 的第一项和第三项选出。
当然,本申请并不限定迭代值的具体选择,例如在一些实施例中也可以选 择迭代值为
Figure BDA00028987499100000910
Figure BDA00028987499100000911
下面以轮式双足机器人100举例说明观测器的形式。应当理解,对于有着 不同形式的状态矩阵,观测器可以有多种实施方式。本申请并不对观测器形式 的具体选择进行限制。
在一些实施例中,对于公式四中的状态矩阵,观测器可以采用以下形式:
公式六:
Figure BDA0002898749910000101
其中,观测器估计的状态矩阵
Figure BDA0002898749910000102
Figure BDA0002898749910000103
本领域技术人员将理解公式六形式的观测器可以观测公式四形式的状态矩 阵。
观测器中的矩阵参数
Figure BDA0002898749910000104
可以根据M,m,l,g等基础数据确定,矩阵参数
Figure BDA0002898749910000105
是 已知的。ym为迭代值的实际值,
Figure BDA0002898749910000106
为迭代值的估计值。L可以是预先人为设置的 参数,表示观测器根据迭代值实际值与估计值差值进行迭代更新的幅度。
由此,本实施例示例性的公开了如何基于基础数据确定观测器。
步骤403:基于运动状态数据,通过观测器确定状态矩阵。
基于运动状态数据,通过观测器确定内含干扰参数的状态矩阵。在一些实 施例中,将观测器估计的状态矩阵根据观测到的运动状态数据进行迭代更新, 最终确定得到状态矩阵。
在一些实施例中,首先通过观测器估计状态矩阵,从而根据观测器估计出 的状态矩阵确定迭代值的估计值,以及根据运动状态数据确定迭代值的实际值, 并计算迭代值估计值与实际值之间的差值,通过观测器根据差值更新状态矩阵。 在一些实施例中,多次重复这一过程,使得观测器估计的状态矩阵进行迭代更 新,不断逼近状态矩阵,最终确定状态矩阵。在一些实施例中,以轮式双足机 器人100为例,观测器公式六中的估计状态矩阵
Figure BDA0002898749910000107
根据迭代值差值
Figure BDA0002898749910000108
进行 迭代更新,最终确定状态矩阵
Figure BDA0002898749910000109
包含估计到的
Figure BDA00028987499100001010
以及干扰参数
Figure BDA00028987499100001011
由于迭代更新的方式可以不断适应新的状态矩阵,此实施例可以确定运动过程 中干扰参数发生变化的状态矩阵。例如即使轮式双足机器人100的高度在运动 过程中发生变化导致了平衡点的变化及状态矩阵的变化,观测器仍旧可以根据状态发生变化后的运动状态数据调整确定的变化后的状态矩阵。
由此,本实施例示例性的公开了如何基于运动状态数据,通过观测器确定 内含干扰参数的状态矩阵。
步骤404:基于状态矩阵确定对轮式机器人进行控制的力矩。
根据观测器得到的状态矩阵,可以确定对机器人进行的控制操作,比如施 加控制力矩。当目标是维持轮式机器人的静止平衡时,系统的目标状态,也即 是动力学系统的目标输出为趋于零的
Figure BDA0002898749910000111
和趋于零的
Figure BDA0002898749910000112
根据系统的目标输出确定 系统的输入。
在一个实施例中,确定对轮式机器人进行控制的输入矩阵,将输入矩阵与 状态矩阵的乘积,确定为对轮式机器人进行控制的力矩。
以轮式双足机器人100为例,仅当存在输入矩阵K=[kx kd]和一个特定向 量Xc时,能够使得
Figure BDA0002898749910000113
Figure BDA0002898749910000114
趋于零。其中,kx和kd为输入矩阵中的元素,kx为增益 矩阵,kd为增益系数。示意性的,可以基于如下公式七和公式八计算得到满足 输入矩阵K。
公式七:
Figure BDA0002898749910000115
公式八:0=[C 0]Xc
其中
Figure BDA0002898749910000116
将公式七和公式八连列方程组,从而计算得到输入矩阵K。
将输入矩阵K和上述状态矩阵
Figure BDA0002898749910000117
的的乘积作为力矩u输入至电机。
由此,通过实施例公开了基于状态矩阵确定对轮式机器人进行控制的力矩 的方法,但本申请并不限定具体确定对轮式机器人进行控制的力矩的具体方法。
步骤405:以力矩控制轮式机器人处于静止站定状态。
在一些实施例中,基于力矩对轮式机器人的车轮进行控制,将轮式机器人 稳定在静止站定状态。本申请并不限定以力矩控制轮式机器人处于静止站定状 态的具体实施方法。
综上所述,本申请实施例提供的运动状态的控制方法,在确定对轮式机器 人进行控制的力矩之前,首先通过观测器确定在当前状态下轮式机器人的状态 矩阵,该状态矩阵内含平衡误差(干扰参数),从而基于该状态参数确定对轮式 机器人进行控制的力矩,并以该力矩对轮式机器人的车轮进行控制,从而将轮 式机器人控制处于静止站定状态,提高了对存在平衡误差的轮式机器人的控制 准确率。
示意性的,本申请应用于轮式双足机器人100的实施例,通过线性输出调 节对轮式机器人进行控制,并通过实验验证了线性输出调节的稳定性和性能。 首先,所有参数汇总在表1中。
表一
Figure BDA0002898749910000121
其中,第二行中的Robot/IPC表示轮式双足机器人100的基础数据,如:m 为主体部分质量11kg;M为车轮质量3kg;g为重力加速度9.81m/s2;l为身高, 在0.37米到0.7米之间调节(即为在不同使用角度下,主体部分的马达到地面 的距离);rw表示车轮半径,dw表示两个车轮之间的距离。
第三行中的Output regulation表示本申请实施例中得到的线性输出调节方法中使用的参数,其中包括但不仅限于输入矩阵中的增益矩阵kx,增益参数kd以 及矩阵L。
根据上述参数,通过惯性测量单元(Inertial Measurement Unit,IMU)测量 俯仰角θ和横滚角φ和他们的速度。与此同时,通过电机编码器读取右车轮的角 速度ωr(rad/s)和左车轮的角速度ωl(rad/s)。然后计算得到轮式双足机器人100 在x方向上的直线速度
Figure BDA0002898749910000122
和偏航速度
Figure BDA0002898749910000123
如下公式九:
公式九:
Figure BDA0002898749910000124
Figure BDA0002898749910000125
基于平衡力u在对轮式双足机器人100进行控制时,通过公式τ=0.5rwu转 换为力矩,τ即左右两个电机的平均力矩。另一方面,平均力矩τ与偏航力矩
Figure BDA0002898749910000126
Figure BDA0002898749910000127
相加为施加在左电机上的力矩,而平均力矩τ与偏航力矩
Figure BDA0002898749910000128
Figure BDA0002898749910000129
相减为施加在右电机上的力矩,以此旋转轮式双足机器人100,其中
Figure BDA00028987499100001210
为一个远程控制器给出的相对偏航速度。由于偏航力矩之和不改变x方向的 总力矩,所以不会破坏机器人的平衡。
实验中,使用型号为PICO-WHU4的中央处理器(Central Processing Unit,CPU),其处理周期为Ts≈0.002s,从而通过
Figure BDA0002898749910000131
计算x,并离散 化观测器。其中,xk表示k时刻的距离,xk-1表示k-1时刻的距离,
Figure BDA0002898749910000132
表示 k-1时刻的速度。
示意性的,以控制轮式双足机器人100处于站定状态的实验结果为例对本 申请实施例中提供的线性输出调节方法进行说明。
如图5所示,其示出了实验过程中轮式双足机器人520的状态,即在高度 不变的情况下控制轮式双足机器人520处于站定状态。
在一些实施例中,采用带观测器的线性输出调节,使机器人在最小高度姿 势保持静止。如下图6至图10将观测器估计的物理量与实际观测值进行对比。
图6为以时间为横坐标,观测器对俯仰角的估计值与实际值进行对比的曲 线图。如图6所示,轮式双足机器人520在状态调整的过程中,俯仰角的观测 器估计值如曲线620,实际值如曲线630。轮式双足机器人520最终平衡时,俯 仰角的值如曲线610所示。
图7为以时间为横坐标,观测器对俯仰角速度的估计值与实际值进行对比 的曲线图。如图7所示,轮式双足机器人520在状态调整的过程中,俯仰角速 度的观测器估计值如曲线710,实际值如曲线720。
图8为以时间为横坐标,观测器对位移的估计值与实际值进行对比的曲线 图。如图8所示,轮式双足机器人520在状态调整的过程中,位移的观测器估 计值如曲线810,实际值如曲线820。
图9为以时间为横坐标,观测器对线速度的估计值与实际值进行对比的曲 线图。如图9所示,轮式双足机器人520在状态调整的过程中,线速度的观测 器估计值如曲线910,实际值如曲线920。
图10为以时间为横坐标,观测器对俯仰角速度的估计值与实际值的差值变 化的曲线图。如图10所示,轮式双足机器人520在状态调整的过程中,差值变 化如曲线1010所示。
由图6至图10可见,在实际平衡点未知时,估计的状态矩阵逐渐向实际状 态矩阵逼近,轮式双足机器人520成功达到静止平衡状态。在平衡状态下,估 计的状态矩阵与实际状态矩阵依旧有一定区别,这是由于轮子和地毯之间的摩 擦。然而,由图10可见,上述线性输出调节在平衡状态达成后,依旧进一步将 估计值调整逼近实际值。
综上所述,本申请实施例提供的运动状态控制方法,在确定对轮式机器人 进行控制的力矩之前,首先确定轮式机器人的状态矩阵,该状态矩阵体现了轮 式机器人的干扰参数,从而基于该状态矩阵确定对轮式机器人进行控制的力矩, 并以该力矩对轮式机器人的车轮进行控制,从而将轮式机器人控制处于静止站 定状态,提高了对轮式机器人的控制准确率。
图11是本申请一个示例性实施例提供的运动状态的控制装置的结构框图, 如图11所示,该装置包括:
获取模块1110,用于执行步骤301及步骤401中的实施例;
确定模块1120,执行步骤302、步骤303,步骤402、步骤403及步骤404 中的实施例;
控制模块1130,用于执行步骤303及步骤405中的实施例。
综上所述,本申请实施例提供的运动状态控制方法,在确定对轮式机器人 进行控制的力矩之前,首先确定轮式机器人的状态矩阵,该状态矩阵体现了轮 式机器人的干扰参数,从而基于该状态矩阵确定对轮式机器人进行控制的力矩, 并以该力矩对轮式机器人的车轮进行控制,从而将轮式机器人控制处于静止站 定状态,提高了对轮式机器人的控制准确率。
需要说明的是:上述实施例提供的运动状态控制装置,仅以上述各功能模 块的划分进行举例说明,实际应用中,可以根据需要而将上述功能分配由不同 的功能模块完成,即将设备的内部结构划分成不同的功能模块,以完成以上描 述的全部或者部分功能。另外,上述实施例提供的运动状态的控制装置,与运 动状态的控制方法实施例属于同一构思,其具体实现过程详见方法实施例,这 里不再赘述。
图12示出了本申请一个示例性实施例提供的电子设备1200的结构框图。 该电子设备1200可以是便携式移动终端,比如:智能手机、平板电脑、MP3播 放器(Moving PictureExperts Group Audio Layer III,动态影像专家压缩标准音频 层面3)、MP4(MovingPicture Experts Group Audio Layer IV,动态影像专家压 缩标准音频层面4)播放器、笔记本电脑或台式电脑。电子设备1200还可能被 称为用户设备、便携式终端、膝上型终端、台式终端等其他名称。本申请实施 例中,该电子设备1200实现为轮式机器人中的控制设备部分。
通常,电子设备1200包括有:处理器1201和存储器1202。
处理器1201可以包括一个或多个处理核心,比如4核心处理器、8核心处 理器等。处理器1201可以采用DSP(Digital Signal Processing,数字信号处理)、 FPGA(Field-Programmable Gate Array,现场可编程门阵列)、PLA (Programmable Logic Array,可编程逻辑阵列)中的至少一种硬件形式来实现。 处理器1201也可以包括主处理器和协处理器,主处理器是用于对在唤醒状态下 的数据进行处理的处理器,也称CPU(CentralProcessing Unit,中央处理器); 协处理器是用于对在待机状态下的数据进行处理的低功耗处理器。在一些实施 例中,处理器1201可以集成有GPU(Graphics Processing Unit,图像处理器), GPU用于负责显示屏所需要显示的内容的渲染和绘制。一些实施例中,处理器1201还可以包括AI(Artificial Intelligence,人工智能)处理器,该AI处理器用 于处理有关机器学习的计算操作。
存储器1202可以包括一个或多个计算机可读存储介质,该计算机可读存储 介质可以是非暂态的。存储器1202还可包括高速随机存取存储器,以及非易失 性存储器,比如一个或多个磁盘存储设备、闪存存储设备。在一些实施例中, 存储器1202中的非暂态的计算机可读存储介质用于存储至少一个指令,该至少 一个指令用于被处理器1201所执行以实现本申请中方法实施例提供的运动状态 的控制方法。
在一些实施例中,电子设备1200还可选包括有:外围设备接口1203和至 少一个外围设备。处理器1201、存储器1202和外围设备接口1203之间可以通 过总线或信号线相连。各个外围设备可以通过总线、信号线或电路板与外围设 备接口1203相连。具体地,外围设备包括:射频电路1204、显示屏1205、摄 像头组件1206、音频电路1207、定位组件1208和电源1209中的至少一种。
外围设备接口1203可被用于将I/O(Input/Output,输入/输出)相关的至少 一个外围设备连接到处理器1201和存储器1202。在一些实施例中,处理器1201、 存储器1202和外围设备接口1203被集成在同一芯片或电路板上;在一些其他 实施例中,处理器1201、存储器1202和外围设备接口1203中的任意一个或两 个可以在单独的芯片或电路板上实现,本实施例对此不加以限定。
射频电路1204用于接收和发射RF(Radio Frequency,射频)信号,也称电 磁信号。射频电路1204通过电磁信号与通信网络以及其他通信设备进行通信。 射频电路1204将电信号转换为电磁信号进行发送,或者,将接收到的电磁信号 转换为电信号。可选地,射频电路1204包括:天线系统、RF收发器、一个或 多个放大器、调谐器、振荡器、数字信号处理器、编解码芯片组、用户身份模 块卡等等。射频电路1204可以通过至少一种无线通信协议来与其它终端进行通 信。该无线通信协议包括但不限于:万维网、城域网、内联网、各代移动通信 网络(2G、3G、4G及5G)、无线局域网和/或Wi-Fi(Wireless Fidelity,无线保 真)网络。在一些实施例中,射频电路1204还可以包括NFC(Near Field Communication,近距离无线通信)有关的电路,本申请对此不加以限定。
显示屏1205用于显示UI(User Interface,用户界面)。该UI可以包括图形、 文本、图标、视频及其它们的任意组合。当显示屏1205是触摸显示屏时,显示 屏1205还具有采集在显示屏1205的表面或表面上方的触摸信号的能力。该触 摸信号可以作为控制信号输入至处理器1201进行处理。此时,显示屏1205还 可以用于提供虚拟按钮和/或虚拟键盘,也称软按钮和/或软键盘。在一些实施例 中,显示屏1205可以为一个,设置在电子设备1200的前面板;在另一些实施 例中,显示屏1205可以为至少两个,分别设置在电子设备1200的不同表面或 呈折叠设计;在另一些实施例中,显示屏1205可以是柔性显示屏,设置在电子 设备1200的弯曲表面上或折叠面上。甚至,显示屏1205还可以设置成非矩形 的不规则图形,也即异形屏。显示屏1205可以采用LCD(Liquid Crystal Display, 液晶显示屏)、OLED(Organic Light-Emitting Diode,有机发光二极管)等材质制备。
摄像头组件1206用于采集图像或视频。可选地,摄像头组件1206包括前 置摄像头和后置摄像头。通常,前置摄像头设置在终端的前面板,后置摄像头 设置在终端的背面。在一些实施例中,后置摄像头为至少两个,分别为主摄像 头、景深摄像头、广角摄像头、长焦摄像头中的任意一种,以实现主摄像头和 景深摄像头融合实现背景虚化功能、主摄像头和广角摄像头融合实现全景拍摄 以及VR(Virtual Reality,虚拟现实)拍摄功能或者其它融合拍摄功能。在一些 实施例中,摄像头组件1206还可以包括闪光灯。闪光灯可以是单色温闪光灯, 也可以是双色温闪光灯。双色温闪光灯是指暖光闪光灯和冷光闪光灯的组合, 可以用于不同色温下的光线补偿。
音频电路1207可以包括麦克风和扬声器。麦克风用于采集用户及环境的声 波,并将声波转换为电信号输入至处理器1201进行处理,或者输入至射频电路 1204以实现语音通信。出于立体声采集或降噪的目的,麦克风可以为多个,分 别设置在电子设备1200的不同部位。麦克风还可以是阵列麦克风或全向采集型 麦克风。扬声器则用于将来自处理器1201或射频电路1204的电信号转换为声 波。扬声器可以是传统的薄膜扬声器,也可以是压电陶瓷扬声器。当扬声器是 压电陶瓷扬声器时,不仅可以将电信号转换为人类可听见的声波,也可以将电 信号转换为人类听不见的声波以进行测距等用途。在一些实施例中,音频电路 1207还可以包括耳机插孔。
定位组件1208用于定位电子设备1200的当前地理位置,以实现导航或LBS(Location Based Service,基于位置的服务)。定位组件1208可以是基于美国的 GPS(Global Positioning System,全球定位系统)、中国的北斗系统或俄罗斯的 伽利略系统的定位组件。
电源1209用于为电子设备1200中的各个组件进行供电。电源1209可以是 交流电、直流电、一次性电池或可充电电池。当电源1209包括可充电电池时, 该可充电电池可以是有线充电电池或无线充电电池。有线充电电池是通过有线 线路充电的电池,无线充电电池是通过无线线圈充电的电池。该可充电电池还 可以用于支持快充技术。
在一些实施例中,电子设备1200还包括有一个或多个传感器1210。该一个 或多个传感器1210包括但不限于:加速度传感器1211、陀螺仪传感器1212、 压力传感器1213、指纹传感器1214、光学传感器1215以及接近传感器1216。
加速度传感器1211可以检测以电子设备1200建立的坐标系的三个坐标轴 上的加速度大小。比如,加速度传感器1211可以用于检测重力加速度在三个坐 标轴上的分量。处理器1201可以根据加速度传感器1211采集的重力加速度信 号,控制显示屏1205以横向视图或纵向视图进行用户界面的显示。加速度传感 器1211还可以用于游戏或者用户的运动数据的采集。
陀螺仪传感器1212可以检测电子设备1200的机体方向及转动角度,陀螺 仪传感器1212可以与加速度传感器1211协同采集用户对电子设备1200的3D 动作。处理器1201根据陀螺仪传感器1212采集的数据,可以实现如下功能: 动作感应(比如根据用户的倾斜操作来改变UI)、拍摄时的图像稳定、游戏控 制以及惯性导航。
压力传感器1213可以设置在电子设备1200的侧边框和/或显示屏1205的下 层。当压力传感器1213设置在电子设备1200的侧边框时,可以检测用户对电 子设备1200的握持信号,由处理器1201根据压力传感器1213采集的握持信号 进行左右手识别或快捷操作。当压力传感器1213设置在显示屏1205的下层时, 由处理器1201根据用户对显示屏1205的压力操作,实现对UI界面上的可操作 性控件进行控制。可操作性控件包括按钮控件、滚动条控件、图标控件、菜单 控件中的至少一种。
指纹传感器1214用于采集用户的指纹,由处理器1201根据指纹传感器1214 采集到的指纹识别用户的身份,或者,由指纹传感器1214根据采集到的指纹识 别用户的身份。在识别出用户的身份为可信身份时,由处理器1201授权该用户 执行相关的敏感操作,该敏感操作包括解锁屏幕、查看加密信息、下载软件、 支付及更改设置等。指纹传感器1214可以被设置在电子设备1200的正面、背 面或侧面。当电子设备1200上设置有物理按键或厂商Logo时,指纹传感器1214 可以与物理按键或厂商Logo集成在一起。
光学传感器1215用于采集环境光强度。在一个实施例中,处理器1201可 以根据光学传感器1215采集的环境光强度,控制显示屏1205的显示亮度。具 体地,当环境光强度较高时,调高显示屏1205的显示亮度;当环境光强度较低 时,调低显示屏1205的显示亮度。在另一个实施例中,处理器1201还可以根 据光学传感器1215采集的环境光强度,动态调整摄像头组件1206的拍摄参数。
接近传感器1216,也称距离传感器,通常设置在电子设备1200的前面板。 接近传感器1216用于采集用户与电子设备1200的正面之间的距离。在一个实 施例中,当接近传感器1216检测到用户与电子设备1200的正面之间的距离逐 渐变小时,由处理器1201控制显示屏1205从亮屏状态切换为息屏状态;当接 近传感器1216检测到用户与电子设备1200的正面之间的距离逐渐变大时,由 处理器1201控制显示屏1205从息屏状态切换为亮屏状态。
本领域技术人员可以理解,图12中示出的结构并不构成对电子设备1200 的限定,可以包括比图示更多或更少的组件,或者组合某些组件,或者采用不 同的组件布置。
本申请的实施例还提供了一种轮式机器人,该轮式机器人包括处理器和存 储器,该存储器中存储有至少一条指令、至少一段程序、代码集或指令集,至 少一条指令、至少一段程序、代码集或指令集由处理器加载并执行以实现上述 各方法实施例提供的运动状态的控制方法。
本申请的实施例还提供了一种计算机可读存储介质,该计算机可读存储介 质上存储有至少一条指令、至少一段程序、代码集或指令集,至少一条指令、 至少一段程序、代码集或指令集由处理器加载并执行,以实现上述各方法实施 例提供的运动状态的控制方法。
本申请的实施例还提供了一种计算机程序产品或计算机程序,该计算机程 序产品或计算机程序包括计算机指令,该计算机指令存储在计算机可读存储介 质中。计算机设备的处理器从计算机可读存储介质读取该计算机指令,处理器 执行该计算机指令,使得该计算机设备执行上述实施例中任一所述的运动状态 的控制方法。
可选地,该计算机可读存储介质可以包括:只读存储器(ROM,Read Only Memory)、随机存取记忆体(RAM,Random Access Memory)、固态硬盘(SSD, Solid State Drives)或光盘等。其中,随机存取记忆体可以包括电阻式随机存取 记忆体(ReRAM,ResistanceRandom Access Memory)和动态随机存取存储器 (DRAM,Dynamic Random AccessMemory)。上述本申请实施例序号仅仅为了 描述,不代表实施例的优劣。
本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过 硬件来完成,也可以通过程序来指令相关的硬件完成,所述的程序可以存储于 一种计算机可读存储介质中,上述提到的存储介质可以是只读存储器,磁盘或 光盘等。
以上所述仅为本申请的可选实施例,并不用以限制本申请,凡在本申请的 精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本申请的 保护范围之内。

Claims (15)

1.一种运动状态的控制方法,其特征在于,应用于轮式机器人中,所述方法包括:
获取基础数据和运动状态数据,所述基础数据用于表示所述轮式机器人的结构特征,所述运动状态数据用于表示所述轮式机器人的运动特征;
基于所述基础数据和所述运动状态数据确定所述轮式机器人的状态矩阵,所述状态矩阵与所述轮式机器人的干扰参数相关,所述干扰参数对应于所述轮式机器人的平衡误差;
基于所述状态矩阵确定对所述轮式机器人进行控制的力矩;
以所述力矩控制所述轮式机器人处于静止站定状态。
2.根据权利要求1所述的方法,其特征在于,所述基于所述基础数据和所述运动状态数据确定所述轮式机器人的状态矩阵,包括:
基于所述基础数据确定观测器;
基于所述运动状态数据,通过所述观测器确定所述状态矩阵。
3.根据权利要求2所述的方法,其特征在于,所述基于所述基础数据确定观测器,包括:
基于所述基础数据确定所述观测器中的矩阵参数;
根据所述矩阵参数获得直接用于确定所述状态矩阵的所述观测器。
4.根据权利要求2所述的方法,其特征在于,所述基于所述运动状态数据,通过观测器确定所述状态矩阵,包括:
通过所述观测器,估计所述状态矩阵;
根据所述状态矩阵确定迭代值的估计值;
根据所述运动状态数据确定所述迭代值的实际值;
计算所述估计值与所述实际值的差值;
通过所述观测器,根据所述差值更新所述状态矩阵;
确定所述状态矩阵。
5.根据权利要求4所述的方法,其特征在于,所述方法还包括:
基于所述轮式机器人的所述状态矩阵的形式,确定所述观测器的形式;
基于所述运动状态数据的内容,确定所述观测器中所述迭代值的形式。
6.根据权利要求4所述的方法,其特征在于,
所述观测器的形式为
Figure FDA0002898749900000021
其中
Figure FDA0002898749900000022
为所述观测器估计的所述状态矩阵,u为控制力矩,L是预先设置的参数,ym为所述迭代值的实际值,
Figure FDA0002898749900000023
为所述迭代值的估计值,
Figure FDA0002898749900000024
是基于所述基础数据确定的参数矩阵。
7.根据权利要求6所述的方法,其特征在于,
Figure FDA0002898749900000025
其中
Figure FDA0002898749900000026
Figure FDA0002898749900000027
m为所述轮式机器人中主体部分的质量,M为所述轮式机器人中车轮的质量,l为所述轮式机器人的身高。
8.根据权利要求4所述的方法,其特征在于,还包括:
在所述轮式机器人的所述状态矩阵发生变化后,确定变化后的状态矩阵。
9.根据权利要求1所述的方法,其特征在于,所述基于所述状态矩阵确定对所述轮式机器人进行控制的力矩,包括:
确定对所述轮式机器人进行控制的输入矩阵;
将所述输入矩阵与所述状态矩阵的乘积,确定为对所述轮式机器人进行控制的力矩。
10.根据权利要求9所述的方法,其特征在于,所述确定对所述轮式机器人进行控制的输入矩阵,包括:
确定当所述轮式机器人的俯仰角速度与线速度趋近于零时,所述控制力矩与所述状态矩阵的等式关系;
根据所述等式关系确定所述输入矩阵。
11.根据权利要求9所述的方法,其特征在于,所述输入矩阵K满足:
Figure FDA0002898749900000031
以及0=[C 0]Xc,其中
Figure FDA0002898749900000032
m为所述轮式机器人中主体部分的质量,M为所述轮式机器人中车轮的质量,l为所述轮式机器人的身高,
Figure FDA0002898749900000033
Figure FDA0002898749900000034
Figure FDA0002898749900000035
L是预先设置的参数。
12.根据权利要求1至11任一所述的方法,其特征在于,所述轮式机器人包括主体部分和轮腿部分,所述轮腿部分和所述主体部分呈倒立摆结构,所述轮式机器人的身高由所述轮腿部分进行调整。
13.一种用于控制轮式机器人的运动状态的控制装置,其特征在于,所述装置包括:
获取模块,用于获取基础数据和运动状态数据,所述基础数据用于表示所述轮式机器人的结构特征,所述运动状态数据用于表示所述轮式机器人的运动特征;
确定模块,用于基于所述基础数据和所述运动状态数据确定所述轮式机器人的状态矩阵,所述状态矩阵与所述轮式机器人的干扰参数相关,所述干扰参数对应于所述轮式机器人的平衡误差;
所述确定模块,还用于基于所述状态矩阵确定对所述轮式机器人进行控制的力矩;
控制模块,用于以所述力矩控制所述轮式机器人处于静止站定状态。
14.一种轮式机器人,其特征在于,所述轮式机器人包括处理器和存储器,所述存储器中存储有至少一段程序,所述至少一段程序由所述处理器加载并执行以实现如权利要求1至11任一所述的运动状态的控制方法。
15.一种计算机可读存储介质,其特征在于,所述存储介质中存储有至少一段程序,所述至少一段程序由处理器加载并执行以实现如权利要求1至11任一所述的运动状态的控制方法。
CN202110049662.8A 2021-01-14 2021-01-14 运动状态的控制方法、装置、设备及可读存储介质 Pending CN114764241A (zh)

Priority Applications (5)

Application Number Priority Date Filing Date Title
CN202110049662.8A CN114764241A (zh) 2021-01-14 2021-01-14 运动状态的控制方法、装置、设备及可读存储介质
EP22738964.0A EP4246271A4 (en) 2021-01-14 2022-01-10 METHOD AND APPARATUS FOR CONTROLLING MOTION STATE, DEVICE AND READABLE RECORDING MEDIUM
PCT/CN2022/071024 WO2022152083A1 (zh) 2021-01-14 2022-01-10 运动状态的控制方法、装置、设备及可读存储介质
JP2023521655A JP7518975B2 (ja) 2021-01-14 2022-01-10 運動状態の制御方法、装置、ホイールロボット及びプログラム
US17/966,027 US20230168693A1 (en) 2021-01-14 2022-10-14 Motion state control method and apparatus, device, and readable storage medium

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110049662.8A CN114764241A (zh) 2021-01-14 2021-01-14 运动状态的控制方法、装置、设备及可读存储介质

Publications (1)

Publication Number Publication Date
CN114764241A true CN114764241A (zh) 2022-07-19

Family

ID=82363090

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110049662.8A Pending CN114764241A (zh) 2021-01-14 2021-01-14 运动状态的控制方法、装置、设备及可读存储介质

Country Status (5)

Country Link
US (1) US20230168693A1 (zh)
EP (1) EP4246271A4 (zh)
JP (1) JP7518975B2 (zh)
CN (1) CN114764241A (zh)
WO (1) WO2022152083A1 (zh)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024067440A1 (zh) * 2022-09-30 2024-04-04 腾讯科技(深圳)有限公司 两轮机器人的控制方法、装置、介质、程序及机器人

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111776106B (zh) * 2020-08-12 2024-02-23 腾讯科技(深圳)有限公司 机械腿和轮式移动设备
CN118514083A (zh) * 2024-07-19 2024-08-20 湖南视比特机器人有限公司 多机器人联合标定方法、系统和计算机设备

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108327812A (zh) * 2018-03-23 2018-07-27 重庆大学 一种多行走方式轮腿式机器人
CN110764413A (zh) * 2019-10-29 2020-02-07 中国科学院自动化研究所 轮腿机器人的自稳定控制方法、系统、装置
EP3696060A1 (en) * 2019-02-18 2020-08-19 Max-Planck-Gesellschaft zur Förderung der Wissenschaften e.V. Robot leg and robotic system

Family Cites Families (23)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2004299010A (ja) 2003-03-31 2004-10-28 Fanuc Ltd ロボットのたわみ補正装置及びたわみ補正方法
KR100709556B1 (ko) 2005-10-19 2007-04-20 한국과학기술연구원 인간형 로봇의 보행 제어 방법
JP4797775B2 (ja) * 2006-04-24 2011-10-19 株式会社日立製作所 2足型移動機構
US8083013B2 (en) * 2006-12-06 2011-12-27 The Regents Of The University Of California Multimodal agile robots
US8041456B1 (en) * 2008-10-22 2011-10-18 Anybots, Inc. Self-balancing robot including an ultracapacitor power source
JP5488095B2 (ja) 2010-03-23 2014-05-14 トヨタ自動車株式会社 倒立型移動体及びその制御方法
JP5560234B2 (ja) 2011-05-31 2014-07-23 トヨタテクニカルディベロップメント株式会社 重心角推定方法及び同方法によって制御される倒立車輪型走行体
WO2013084354A1 (ja) 2011-12-09 2013-06-13 株式会社日立製作所 倒立振子型移動装置、および、その制御方法
JP5907037B2 (ja) 2012-10-16 2016-04-20 株式会社豊田中央研究所 移動体
WO2014141356A1 (ja) 2013-03-11 2014-09-18 株式会社日立製作所 移動体
EP2933069B1 (en) * 2014-04-17 2019-07-03 Softbank Robotics Europe Omnidirectional wheeled humanoid robot based on a linear predictive position and velocity controller
CN104155976B (zh) 2014-07-18 2016-08-24 北京理工大学 自主式球轮移动机器人及其控制方法
JP6267086B2 (ja) 2014-09-10 2018-01-24 ファナック株式会社 伝達角度算出方法、伝達角度補正装置、ロボットの制御方法およびロボットの制御装置
CN104316055B (zh) * 2014-09-19 2018-08-17 南京航空航天大学 一种基于改进的扩展卡尔曼滤波算法的两轮自平衡机器人姿态解算方法
CN108121334A (zh) * 2016-11-28 2018-06-05 沈阳新松机器人自动化股份有限公司 一种自平衡机器人运动控制方法及装置
CN107024938B (zh) * 2017-04-28 2020-07-07 智梓科技(深圳)有限公司 一种轮式机器人的平衡系统及其控制方法
CN107414793B (zh) * 2017-08-01 2020-07-31 韩方元 一种混联步行机器人的构建方法及其混联步行机器人
US10802508B2 (en) * 2018-02-22 2020-10-13 Boston Dynamics, Inc. Mobile robot
CN110525535B (zh) * 2019-07-25 2024-10-15 广东省智能制造研究所 一种双轮足混合自平衡机器人
CN111216826A (zh) * 2020-01-14 2020-06-02 华南理工大学广州学院 一种球移动平衡机器人系统
CN113753150B (zh) * 2021-05-31 2024-01-12 腾讯科技(深圳)有限公司 轮腿式机器人的控制方法、装置、设备及可读存储介质
CN113753146B (zh) * 2021-05-31 2023-11-14 腾讯科技(深圳)有限公司 控制机器人进行空翻运动的方法及机器人
CN113485398B (zh) * 2021-07-19 2024-02-09 北京理工大学 一种轮式双足机器人姿态控制方法

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108327812A (zh) * 2018-03-23 2018-07-27 重庆大学 一种多行走方式轮腿式机器人
EP3696060A1 (en) * 2019-02-18 2020-08-19 Max-Planck-Gesellschaft zur Förderung der Wissenschaften e.V. Robot leg and robotic system
CN110764413A (zh) * 2019-10-29 2020-02-07 中国科学院自动化研究所 轮腿机器人的自稳定控制方法、系统、装置

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
丁希仑;徐坤;: "一种新型变结构轮腿式机器人的设计与分析", 中南大学学报(自然科学版), no. 1, 10 September 2009 (2009-09-10) *
刘学超: "两轮自平衡小车的设计与变结构控制研究", 硕士电子期刊, 15 January 2009 (2009-01-15) *
李家宸: "轮腿式仿生机器人运动控制研究", 硕士电子期刊, 15 February 2020 (2020-02-15) *

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024067440A1 (zh) * 2022-09-30 2024-04-04 腾讯科技(深圳)有限公司 两轮机器人的控制方法、装置、介质、程序及机器人

Also Published As

Publication number Publication date
EP4246271A4 (en) 2024-03-27
JP7518975B2 (ja) 2024-07-18
WO2022152083A1 (zh) 2022-07-21
US20230168693A1 (en) 2023-06-01
EP4246271A1 (en) 2023-09-20
JP2023547054A (ja) 2023-11-09

Similar Documents

Publication Publication Date Title
US20200357163A1 (en) Method and apparatus for adjusting viewing angle in virtual environment, and readable storage medium
CN114764241A (zh) 运动状态的控制方法、装置、设备及可读存储介质
CN110986930B (zh) 设备定位方法、装置、电子设备及存储介质
CN113752250B (zh) 机器人关节的控制方法、装置、机器人及存储介质
WO2004020946A1 (ja) ヘッドトラッキング方法及び装置
CN109166150B (zh) 获取位姿的方法、装置存储介质
CN110134744B (zh) 对地磁信息进行更新的方法、装置和系统
JP5964495B2 (ja) 方向検知コンピューティングデバイス
CN108196701B (zh) 确定姿态的方法、装置及vr设备
WO2023130824A1 (zh) 欠驱动系统机器人的运动控制方法和欠驱动系统机器人
US20240217296A1 (en) Mobile robot motion control method and mobile robot
CN108393882B (zh) 机器人姿态控制方法及机器人
US20220253198A1 (en) Image processing device, image processing method, and recording medium
CN114791729A (zh) 轮式机器人的控制方法、装置、设备及可读存储介质
CN115480594A (zh) 跳跃控制方法、装置、设备及介质
CN115480483A (zh) 机器人的动力学参数辨识方法、装置、设备及介质
CN115480560A (zh) 运动状态的控制方法、装置、轮腿式机器人及存储介质
CN115102457A (zh) 力矩控制方法、装置、设备、存储介质和程序产品
KR20200067446A (ko) 구형 이동 장치 및 그 위에서 움직일 수 있는 제 2 장치를 포함하는 전자 장치, 및 제 2 장치의 자세 제어 방법
CN111284623B (zh) 轮式移动设备、平衡控制方法及存储介质
CN111717205B (zh) 车辆控制方法、装置、电子设备及计算机可读存储介质
CN115480561A (zh) 运动状态的控制方法、装置、轮腿式机器人及存储介质
CN113110552B (zh) 飞行器的姿态控制方法、装置、设备及可读存储介质
CN113176789B (zh) 飞行器的控制方法、装置、设备及可读存储介质
EP3912770B1 (en) Rotatable electronic device comprising sensor

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
REG Reference to a national code

Ref country code: HK

Ref legal event code: DE

Ref document number: 40071951

Country of ref document: HK