CN117245648A - A robot virtual modeling and tactile control method and device - Google Patents
A robot virtual modeling and tactile control method and device Download PDFInfo
- Publication number
- CN117245648A CN117245648A CN202310905781.8A CN202310905781A CN117245648A CN 117245648 A CN117245648 A CN 117245648A CN 202310905781 A CN202310905781 A CN 202310905781A CN 117245648 A CN117245648 A CN 117245648A
- Authority
- CN
- China
- Prior art keywords
- virtual
- data
- robot
- force feedback
- model
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 53
- 230000003993 interaction Effects 0.000 claims abstract description 115
- 230000009471 action Effects 0.000 claims abstract description 71
- 230000009466 transformation Effects 0.000 claims abstract description 54
- 230000008569 process Effects 0.000 claims abstract description 24
- 239000000463 material Substances 0.000 claims description 45
- 239000011159 matrix material Substances 0.000 claims description 16
- 230000005484 gravity Effects 0.000 claims description 12
- 230000002452 interceptive effect Effects 0.000 claims description 5
- 230000003190 augmentative effect Effects 0.000 abstract description 4
- 230000002457 bidirectional effect Effects 0.000 abstract 1
- 230000000694 effects Effects 0.000 description 8
- 230000008447 perception Effects 0.000 description 5
- 238000005516 engineering process Methods 0.000 description 4
- 230000006870 function Effects 0.000 description 3
- 230000001960 triggered effect Effects 0.000 description 3
- 230000006399 behavior Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000004519 manufacturing process Methods 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 239000011521 glass Substances 0.000 description 1
- 238000007654 immersion Methods 0.000 description 1
- 230000003252 repetitive effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J11/00—Manipulators not otherwise provided for
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
Description
技术领域Technical field
本申请涉及机器人仿真与控制技术领域,尤其是涉及到一种机器人虚拟建模与触觉控制方法及装置。The present application relates to the field of robot simulation and control technology, and in particular to a robot virtual modeling and tactile control method and device.
背景技术Background technique
随着制造业和物流业的不断发展,机器人被广泛应用于流水线生产、装配、物流运输等环节,成为智能工厂建设的核心。机器人可以完成许多重复性高、危险性高、精度要求高的任务,因此对机器人的高精度控制尤为重要。With the continuous development of the manufacturing and logistics industries, robots are widely used in assembly line production, assembly, logistics and transportation, and have become the core of smart factory construction. Robots can complete many tasks that are highly repetitive, dangerous, and require high precision, so high-precision control of robots is particularly important.
机器人虚拟建模是模拟机器人运动和控制的一种技术,通过计算机模拟机器人的动作和效果,用于机器人的设计、布局和控制等方面。特别是虚拟现实、增强现实、混合现实等技术的提出,通过对机器人的实时虚拟建模,可以仿真、优化、修正实体机器人的控制,成为支持人机交互、协同控制的关键。Robot virtual modeling is a technology that simulates the movement and control of robots. It simulates the movements and effects of robots through computers and is used in the design, layout and control of robots. In particular, with the introduction of technologies such as virtual reality, augmented reality, and mixed reality, real-time virtual modeling of robots can simulate, optimize, and correct the control of physical robots, which has become the key to supporting human-computer interaction and collaborative control.
在与传统机器人虚拟模型交互过程中,只能依靠头戴式显示器和手柄进行单向的视、听觉操作,这会导致虚拟建模与实际机器人之间存在一定的差异,也就是说,传统的机器人虚拟建模和交互具有较低的真实性和操控性,难以满足工业应用的需求。During the interaction with the traditional robot virtual model, one can only rely on the head-mounted display and the handle for one-way visual and auditory operations, which will lead to a certain difference between the virtual model and the actual robot. That is to say, the traditional Robot virtual modeling and interaction have low authenticity and controllability, making it difficult to meet the needs of industrial applications.
发明内容Contents of the invention
有鉴于此,本申请提供了一种机器人虚拟建模与触觉控制方法及装置,有助于提高操作者与虚拟机器人之间交互的真实性。In view of this, this application provides a robot virtual modeling and tactile control method and device, which helps to improve the authenticity of the interaction between the operator and the virtual robot.
根据本申请的一个方面,提供了一种机器人虚拟建模与触觉控制方法,所述方法包括:According to one aspect of the present application, a robot virtual modeling and tactile control method is provided, which method includes:
根据机器人的物理实体数据在虚拟环境中建立虚拟机器人,建立力反馈控制器和所述虚拟机器人之间的连接;Establish a virtual robot in the virtual environment based on the physical entity data of the robot, and establish a connection between the force feedback controller and the virtual robot;
操作者操作所述力反馈控制器,并将所述力反馈控制器的末端坐标数据发送给所述虚拟机器人;The operator operates the force feedback controller and sends the end coordinate data of the force feedback controller to the virtual robot;
所述虚拟机器人根据所述末端坐标数据计算姿态数据,根据所述姿态数据控制所述虚拟机器人进行姿态变换,获取所述姿态变换过程中与所述虚拟环境进行交互的目标交互数据,将所述目标交互数据发送给力反馈控制器;The virtual robot calculates posture data according to the terminal coordinate data, controls the virtual robot to perform posture transformation according to the posture data, obtains target interaction data that interacts with the virtual environment during the posture transformation process, and converts the The target interaction data is sent to the force feedback controller;
所述力反馈控制器根据所述目标交互数据执行力反馈动作。The force feedback controller performs force feedback actions according to the target interaction data.
可选地,所述物理实体数据包括型号数据、机械尺寸数据、关节数量数据以及运动范围数据,所述根据机器人的物理实体数据在虚拟环境中建立虚拟机器人,包括:Optionally, the physical entity data includes model data, mechanical size data, joint number data, and motion range data. The establishing a virtual robot in a virtual environment based on the physical entity data of the robot includes:
根据所述机器人的型号数据、机械尺寸数据、关节数量数据以及运动范围数据,建立所述虚拟机器人的各部件虚拟模型,根据所述机器人的实际连接关系,组合所述各部件虚拟模型,形成所述虚拟机器人的虚拟三维模型,并绑定所述虚拟三维模型中各关节点的上下级关系;According to the model data, mechanical size data, joint number data and motion range data of the robot, a virtual model of each component of the virtual robot is established. According to the actual connection relationship of the robot, the virtual models of each component are combined to form the virtual model of each component. Describe a virtual three-dimensional model of the virtual robot, and bind the superior-subordinate relationship of each joint point in the virtual three-dimensional model;
根据所述机器人的物理属性和绑定后的虚拟三维模型建立虚拟机器人,其中,所述物理属性包括质量、模型尺寸和表面材质,所述各部件虚拟模型包括底座模型、连杆模型、传感器模型以及前端工具模型。A virtual robot is established according to the physical attributes of the robot and the bound virtual three-dimensional model. The physical attributes include mass, model size and surface material. The virtual models of each component include a base model, a connecting rod model, and a sensor model. and front-end tool models.
可选地,所述绑定所述虚拟三维模型中各关节点的上下级关系,包括:Optionally, binding the superior-subordinate relationship of each joint point in the virtual three-dimensional model includes:
将所述底座模型设置为父节点,并将第一连杆模型设置为所述底座模型的子节点;Set the base model as a parent node, and set the first link model as a child node of the base model;
根据所述机器人的实际连接关系的预设前后顺序,依次将每一个连杆模型设置为前一连杆模型的子节点;According to the preset sequence of the actual connection relationship of the robot, each link model is set as a child node of the previous link model in turn;
将所述传感器模型和所述前端工具模型设置为最后一根连杆模型的子节点。The sensor model and the front-end tool model are set as child nodes of the last connecting rod model.
可选地,所述根据所述机器人的物理属性和绑定后的虚拟三维模型建立虚拟机器人,包括:Optionally, establishing a virtual robot based on the physical attributes of the robot and the bound virtual three-dimensional model includes:
根据所述机器人的质量、模型尺寸和表面材质为所述绑定后的虚拟三维模型搭建刚体组件、碰撞体组件以及表面材质组件,建立虚拟机器人;Build a rigid body component, a collision body component and a surface material component for the bound virtual three-dimensional model according to the mass, model size and surface material of the robot to establish a virtual robot;
其中,所述刚体组件根据所述机器人的质量确定,所述碰撞体组件根据所述机器人的模型尺寸确定,所述表面材质组件根据所述机器人的表面材质属性确定。Wherein, the rigid body component is determined based on the mass of the robot, the collision body component is determined based on the model size of the robot, and the surface material component is determined based on the surface material properties of the robot.
可选地,所述虚拟机器人根据所述末端坐标数据计算姿态数据,包括:Optionally, the virtual robot calculates posture data based on the terminal coordinate data, including:
建立所述虚拟机器人的笛卡尔坐标空间,根据所述末端坐标数据在所述笛卡尔坐标空间建立所述虚拟机器人各关节的独立坐标系;Establishing a Cartesian coordinate space of the virtual robot, and establishing an independent coordinate system for each joint of the virtual robot in the Cartesian coordinate space according to the end coordinate data;
根据所述虚拟机器人各关节的独立坐标系确定所述虚拟机器人相邻关节的变换矩阵;Determine the transformation matrix of adjacent joints of the virtual robot according to the independent coordinate system of each joint of the virtual robot;
根据每个所述相邻关节的变换矩阵,依次计算所述虚拟机器人各关节的姿态信息,获得姿态数据。According to the transformation matrix of each adjacent joint, the posture information of each joint of the virtual robot is calculated sequentially to obtain posture data.
可选地,所述获取所述姿态变换过程中与所述虚拟环境进行交互的目标交互数据,将所述目标交互数据发送给力反馈控制器,包括:Optionally, obtaining target interaction data for interacting with the virtual environment during the posture transformation process, and sending the target interaction data to the force feedback controller includes:
检测所述虚拟机器人在姿态变换过程中是否与所述虚拟环境发生接触,在发生接触时,获取碰撞接触位置数据和所接触虚拟环境的碰撞虚拟属性数据,将所述碰撞接触位置数据和所述碰撞虚拟属性数据作为碰撞目标交互数据,将所述碰撞目标交互数据发送给力反馈控制器,其中,所述虚拟环境中包括虚拟物体;Detect whether the virtual robot comes into contact with the virtual environment during the posture transformation process. When contact occurs, obtain the collision contact position data and the collision virtual attribute data of the contacted virtual environment, and combine the collision contact position data and the collision virtual attribute data of the virtual environment. The collision virtual attribute data is used as the collision target interaction data, and the collision target interaction data is sent to the force feedback controller, wherein the virtual environment includes virtual objects;
若所述操作者在所述虚拟机器人与所述虚拟物体接触的同时按下抓取按钮,则控制所述虚拟机器人执行抓取动作,获取抓取接触位置数据和抓取虚拟属性数据,将所述抓取接触位置数据和所述抓取虚拟属性数据作为抓取目标交互数据,将所述抓取目标交互数据发送给力反馈控制器;若所述操作者松开所述抓取按钮,则控制所述虚拟机器人执行释放动作,其中,所述目标交互数据包括碰撞目标交互数据和抓取目标交互数据。If the operator presses the grasping button while the virtual robot is in contact with the virtual object, the virtual robot is controlled to perform a grasping action, the grasping contact position data and the grasping virtual attribute data are obtained, and all the objects are captured. The grabbing contact position data and the grabbing virtual attribute data are used as grabbing target interaction data, and the grabbing target interaction data is sent to the force feedback controller; if the operator releases the grabbing button, the control The virtual robot performs a release action, wherein the target interaction data includes collision target interaction data and grabbing target interaction data.
可选地,所述虚拟属性数据包括刚体组件参数、碰撞体组件参数以及表面材质组件参数;Optionally, the virtual attribute data includes rigid body component parameters, collision body component parameters and surface material component parameters;
其中,所述刚体组件参数从所接触虚拟物体的刚体组件读取,由所接触虚拟物体质量确定;所述碰撞体组件参数从所接触虚拟物体的碰撞体组件读取,由所接触虚拟物体的模型轮廓确定;所述表面材质组件参数从所接触虚拟物体的表面材质组件读取,由所接触虚拟物体表面的坚硬程度数据、粘性程度数据以及粗糙程度数据确定。Wherein, the rigid body component parameters are read from the rigid body component of the contacted virtual object and are determined by the quality of the contacted virtual object; the collider component parameters are read from the collider component of the contacted virtual object and are determined by the quality of the contacted virtual object. The model outline is determined; the surface material component parameters are read from the surface material component of the virtual object in contact, and determined by the hardness data, viscosity data and roughness data of the surface of the virtual object in contact.
可选地,所述力反馈动作包括重力反馈动作、弹性力反馈动作、粘性力反馈动作以及摩擦力反馈动作,所述力反馈控制器根据所述目标交互数据执行力反馈动作,包括:Optionally, the force feedback action includes a gravity feedback action, an elastic force feedback action, a viscous force feedback action, and a friction force feedback action. The force feedback controller performs a force feedback action according to the target interaction data, including:
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的质量,执行所述重力反馈动作;The force feedback controller performs the gravity feedback action according to the contact position data and the quality of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的坚硬程度数据,执行所述弹性力反馈动作;The force feedback controller performs the elastic force feedback action according to the contact position data and the hardness data of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粘性程度数据,执行所述粘性力反馈动作;The force feedback controller performs the viscous force feedback action according to the contact position data and the viscosity degree data of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粗糙程度数据,执行所述摩擦力反馈动作。The force feedback controller performs the friction force feedback action according to the contact position data and the roughness data of the contacted virtual object.
根据本申请的另一方面,提供了一种机器人虚拟建模与触觉控制装置,所述装置包括:According to another aspect of the present application, a robot virtual modeling and tactile control device is provided, which device includes:
搭建模块,用于根据机器人的物理实体数据在虚拟环境中建立虚拟机器人,建立力反馈控制器和所述虚拟机器人之间的连接;A building module for establishing a virtual robot in a virtual environment based on the physical entity data of the robot, and establishing a connection between the force feedback controller and the virtual robot;
操作模块,用于操作者操作所述力反馈控制器,并将所述力反馈控制器的末端坐标数据发送给所述虚拟机器人;An operation module for the operator to operate the force feedback controller and send the end coordinate data of the force feedback controller to the virtual robot;
交互模块,用于所述虚拟机器人根据所述末端坐标数据计算姿态数据,根据所述姿态数据控制所述虚拟机器人进行姿态变换,获取所述姿态变换过程中与所述虚拟环境进行交互的目标交互数据,将所述目标交互数据发送给力反馈控制器;An interaction module, used for the virtual robot to calculate posture data according to the terminal coordinate data, control the virtual robot to perform posture transformation according to the posture data, and obtain the target interaction with the virtual environment during the posture transformation process. data, sending the target interaction data to the force feedback controller;
反馈模块,用于所述力反馈控制器根据所述目标交互数据执行力反馈动作。A feedback module is used for the force feedback controller to perform force feedback actions according to the target interaction data.
可选地,所述搭建模块,还用于:Optionally, the building module is also used to:
根据所述机器人的型号数据、机械尺寸数据、关节数量数据以及运动范围数据,建立所述虚拟机器人的各部件虚拟模型,根据所述机器人的实际连接关系,组合所述各部件虚拟模型,形成所述虚拟机器人的虚拟三维模型,并绑定所述虚拟三维模型中各关节点的上下级关系;According to the model data, mechanical size data, joint number data and motion range data of the robot, a virtual model of each component of the virtual robot is established. According to the actual connection relationship of the robot, the virtual models of each component are combined to form the virtual model of each component. Describe a virtual three-dimensional model of the virtual robot, and bind the superior-subordinate relationship of each joint point in the virtual three-dimensional model;
根据所述机器人的物理属性和绑定后的虚拟三维模型建立虚拟机器人,其中,所述物理属性包括质量、模型尺寸和表面材质,所述各部件虚拟模型包括底座模型、连杆模型、传感器模型以及前端工具模型。A virtual robot is established according to the physical attributes of the robot and the bound virtual three-dimensional model. The physical attributes include mass, model size and surface material. The virtual models of each component include a base model, a connecting rod model, and a sensor model. and front-end tool models.
可选地,所述搭建模块,还用于:Optionally, the building module is also used to:
将所述底座模型设置为父节点,并将第一连杆模型设置为所述底座模型的子节点;Set the base model as a parent node, and set the first link model as a child node of the base model;
根据所述机器人的实际连接关系的预设前后顺序,依次将每一个连杆模型设置为前一连杆模型的子节点;According to the preset sequence of the actual connection relationship of the robot, each link model is set as a child node of the previous link model in turn;
将所述传感器模型和所述前端工具模型设置为最后一根连杆模型的子节点。The sensor model and the front-end tool model are set as child nodes of the last connecting rod model.
可选地,所述搭建模块,还用于:Optionally, the building module is also used to:
根据所述机器人的质量、模型尺寸和表面材质为所述绑定后的虚拟三维模型搭建刚体组件、碰撞体组件以及表面材质组件,建立虚拟机器人;Build a rigid body component, a collision body component and a surface material component for the bound virtual three-dimensional model according to the mass, model size and surface material of the robot to establish a virtual robot;
其中,所述刚体组件根据所述机器人的质量确定,所述碰撞体组件根据所述机器人的模型尺寸确定,所述表面材质组件根据所述机器人的表面材质属性确定。Wherein, the rigid body component is determined based on the mass of the robot, the collision body component is determined based on the model size of the robot, and the surface material component is determined based on the surface material properties of the robot.
可选地,所述交互模块,还用于:Optionally, the interactive module is also used to:
建立所述虚拟机器人的笛卡尔坐标空间,根据所述末端坐标数据在所述笛卡尔坐标空间建立所述虚拟机器人各关节的独立坐标系;Establishing a Cartesian coordinate space of the virtual robot, and establishing an independent coordinate system for each joint of the virtual robot in the Cartesian coordinate space according to the end coordinate data;
根据所述虚拟机器人各关节的独立坐标系确定所述虚拟机器人相邻关节的变换矩阵;Determine the transformation matrix of adjacent joints of the virtual robot according to the independent coordinate system of each joint of the virtual robot;
根据每个所述相邻关节的变换矩阵,依次计算所述虚拟机器人各关节的姿态信息,获得姿态数据。According to the transformation matrix of each adjacent joint, the posture information of each joint of the virtual robot is calculated sequentially to obtain posture data.
可选地,所述交互模块,还用于:Optionally, the interactive module is also used to:
检测所述虚拟机器人在姿态变换过程中是否与所述虚拟环境发生接触,在发生接触时,获取碰撞接触位置数据和所接触虚拟环境的碰撞虚拟属性数据,将所述碰撞接触位置数据和所述碰撞虚拟属性数据作为碰撞目标交互数据,将所述碰撞目标交互数据发送给力反馈控制器,其中,所述虚拟环境中包括虚拟物体;Detect whether the virtual robot comes into contact with the virtual environment during the posture transformation process. When contact occurs, obtain the collision contact position data and the collision virtual attribute data of the contacted virtual environment, and combine the collision contact position data and the collision virtual attribute data of the virtual environment. The collision virtual attribute data is used as the collision target interaction data, and the collision target interaction data is sent to the force feedback controller, wherein the virtual environment includes virtual objects;
若所述操作者在所述虚拟机器人与所述虚拟物体接触的同时按下抓取按钮,则控制所述虚拟机器人执行抓取动作,获取抓取接触位置数据和抓取虚拟属性数据,将所述抓取接触位置数据和所述抓取虚拟属性数据作为抓取目标交互数据,将所述抓取目标交互数据发送给力反馈控制器;若所述操作者松开所述抓取按钮,则控制所述虚拟机器人执行释放动作,其中,所述目标交互数据包括碰撞目标交互数据和抓取目标交互数据。If the operator presses the grasping button while the virtual robot is in contact with the virtual object, the virtual robot is controlled to perform a grasping action, the grasping contact position data and the grasping virtual attribute data are obtained, and all the objects are captured. The grabbing contact position data and the grabbing virtual attribute data are used as grabbing target interaction data, and the grabbing target interaction data is sent to the force feedback controller; if the operator releases the grabbing button, the control The virtual robot performs a release action, wherein the target interaction data includes collision target interaction data and grabbing target interaction data.
可选地,所述虚拟属性数据包括刚体组件参数、碰撞体组件参数以及表面材质组件参数;Optionally, the virtual attribute data includes rigid body component parameters, collision body component parameters and surface material component parameters;
其中,所述刚体组件参数从所接触虚拟物体的刚体组件读取,由所接触虚拟物体质量确定;所述碰撞体组件参数从所接触虚拟物体的碰撞体组件读取,由所接触虚拟物体的模型轮廓确定;所述表面材质组件参数从所接触虚拟物体的表面材质组件读取,由所接触虚拟物体表面的坚硬程度数据、粘性程度数据以及粗糙程度数据确定。Wherein, the rigid body component parameters are read from the rigid body component of the contacted virtual object and are determined by the quality of the contacted virtual object; the collider component parameters are read from the collider component of the contacted virtual object and are determined by the quality of the contacted virtual object. The model outline is determined; the surface material component parameters are read from the surface material component of the virtual object in contact, and determined by the hardness data, viscosity data and roughness data of the surface of the virtual object in contact.
可选地,所述反馈模块,还用于:Optionally, the feedback module is also used to:
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的质量,执行所述重力反馈动作;The force feedback controller performs the gravity feedback action according to the contact position data and the quality of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的坚硬程度数据,执行所述弹性力反馈动作;The force feedback controller performs the elastic force feedback action according to the contact position data and the hardness data of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粘性程度数据,执行所述粘性力反馈动作;The force feedback controller performs the viscous force feedback action according to the contact position data and the viscosity degree data of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粗糙程度数据,执行所述摩擦力反馈动作。The force feedback controller performs the friction force feedback action according to the contact position data and the roughness data of the contacted virtual object.
借由上述技术方案,本申请提供的一种机器人虚拟建模与触觉控制方法及装置,通过机器人的物理实体数据准确的建立虚拟机器人,操作者操控力反馈控制器,控制虚拟机器人根据末端坐标数据进行姿态变换,获取姿态变换过程中与虚拟环境交互的目标交互数据,力反馈控制器根据目标交互数据执行力反馈动作,给操作者提供力触觉感知,实现了为操作者与虚拟机器人提供双向沉浸式触觉交互的目标,提高了与虚拟机器人进行交互的真实性,可应用于虚拟现实、增强现实下机器人控制。Through the above technical solution, this application provides a method and device for virtual modeling and tactile control of a robot, which accurately establishes a virtual robot through the physical entity data of the robot. The operator controls the force feedback controller to control the virtual robot according to the end coordinate data. Perform posture transformation to obtain target interaction data that interacts with the virtual environment during the posture transformation process. The force feedback controller performs force feedback actions based on the target interaction data, providing the operator with force-tactile perception and achieving two-way immersion between the operator and the virtual robot. The goal of tactile interaction is to improve the authenticity of interaction with virtual robots, and can be applied to robot control under virtual reality and augmented reality.
上述说明仅是本申请技术方案的概述,为了能够更清楚了解本申请的技术手段,而可依照说明书的内容予以实施,并且为了让本申请的上述和其它目的、特征和优点能够更明显易懂,以下特举本申请的具体实施方式。The above description is only an overview of the technical solutions of the present application. In order to have a clearer understanding of the technical means of the present application, they can be implemented according to the content of the description, and in order to make the above and other purposes, features and advantages of the present application more obvious and understandable. , the specific implementation methods of the present application are specifically listed below.
附图说明Description of drawings
此处所说明的附图用来提供对本申请的进一步理解,构成本申请的一部分,本申请的示意性实施例及其说明用于解释本申请,并不构成对本申请的不当限定。在附图中:The drawings described here are used to provide a further understanding of the present application and constitute a part of the present application. The illustrative embodiments of the present application and their descriptions are used to explain the present application and do not constitute an improper limitation of the present application. In the attached picture:
图1示出了本申请实施例提供的一种机器人虚拟建模与触觉控制方法的流程示意图;Figure 1 shows a schematic flow chart of a robot virtual modeling and tactile control method provided by an embodiment of the present application;
图2示出了本申请实施例提供的另一种机器人虚拟建模与触觉控制方法的流程示意图;Figure 2 shows a schematic flow chart of another robot virtual modeling and tactile control method provided by an embodiment of the present application;
图3示出了本申请实施例提供的一种机器人虚拟建模与触觉控制装置的结构示意图。Figure 3 shows a schematic structural diagram of a robot virtual modeling and tactile control device provided by an embodiment of the present application.
具体实施方式Detailed ways
下文中将参考附图并结合实施例来详细说明本申请。需要说明的是,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。The present application will be described in detail below with reference to the accompanying drawings and embodiments. It should be noted that, as long as there is no conflict, the embodiments and features in the embodiments of this application can be combined with each other.
在现有技术中,虚拟机器人主要是对实体机器人的静态呈现,不能够模拟实体机器人在现实世界中的动态行为和属性,如碰撞和质量等,这会导致虚拟机器人与实体机器人之间存在一定的差异,虚拟机器人不能够准确的模拟真实世界里实体机器人的一系列行为;在与传统虚拟机器人交互过程中,只能依靠头戴式显示器和手柄进行单向的视、听觉操作,难以进行双向的沉浸式触觉交互,也就是说,传统的虚拟机器人的创建和交互具有较低的真实性和操控性,难以满足工业应用的需求。In the existing technology, virtual robots are mainly static presentations of physical robots and cannot simulate the dynamic behavior and properties of physical robots in the real world, such as collision and mass. This will lead to certain differences between virtual robots and physical robots. Due to differences, virtual robots cannot accurately simulate a series of behaviors of physical robots in the real world; during interaction with traditional virtual robots, they can only rely on head-mounted displays and handles for one-way visual and auditory operations, and it is difficult to perform two-way Immersive tactile interaction, that is to say, the creation and interaction of traditional virtual robots have low authenticity and controllability, and are difficult to meet the needs of industrial applications.
在本实施例中提供了一种机器人虚拟建模与触觉控制方法,如图1所示,该方法包括:In this embodiment, a robot virtual modeling and tactile control method is provided. As shown in Figure 1, the method includes:
步骤101,根据机器人的物理实体数据在虚拟环境中建立虚拟机器人,建立力反馈控制器和所述虚拟机器人之间的连接。Step 101: Create a virtual robot in the virtual environment based on the physical entity data of the robot, and establish a connection between the force feedback controller and the virtual robot.
本申请实施例可以应用于与虚拟机器人进行交互过程中,实现与虚拟机器人的触觉交互,也可应用于虚拟现实、增强现实下机器人控制。首先,根据机器人的物理实体数据在虚拟环境中建立虚拟机器人,建立力反馈控制器和上述虚拟机器人之间的连接,例如,上述虚拟机器人可以建立在虚拟现实眼镜中,可以通过无线网络、接口等建立力反馈控制器和上述虚拟机器人之间的连接,通过机器人的物理实体数据可以准确的建立虚拟机器人,并建立力反馈控制器和上述虚拟机器人之间的连接,为接下来实现触觉交互做准备。The embodiments of the present application can be applied to the process of interacting with a virtual robot to realize tactile interaction with the virtual robot, and can also be applied to robot control under virtual reality and augmented reality. First, establish a virtual robot in the virtual environment based on the physical entity data of the robot, and establish a connection between the force feedback controller and the above-mentioned virtual robot. For example, the above-mentioned virtual robot can be built in virtual reality glasses, and can be established through wireless networks, interfaces, etc. Establish a connection between the force feedback controller and the above-mentioned virtual robot. The virtual robot can be accurately established through the physical entity data of the robot, and establish a connection between the force feedback controller and the above-mentioned virtual robot to prepare for the subsequent tactile interaction. .
步骤102,操作者操作所述力反馈控制器,并将所述力反馈控制器的末端坐标数据发送给所述虚拟机器人。Step 102: The operator operates the force feedback controller and sends the end coordinate data of the force feedback controller to the virtual robot.
接下来,操作者操作上述力反馈控制器,并将上述力反馈控制器的末端坐标数据发送给上述虚拟机器人,实现了操作者到虚拟机器人的单向触觉交互,使所述虚拟机器人按照所述末端坐标数据进行数据交互。Next, the operator operates the above-mentioned force feedback controller and sends the terminal coordinate data of the above-mentioned force feedback controller to the above-mentioned virtual robot, thereby realizing one-way tactile interaction between the operator and the virtual robot, so that the virtual robot can operate as described End coordinate data for data interaction.
步骤103,所述虚拟机器人根据所述末端坐标数据计算姿态数据,根据所述姿态数据控制所述虚拟机器人进行姿态变换,获取所述姿态变换过程中与所述虚拟环境进行交互的目标交互数据,将所述目标交互数据发送给力反馈控制器。Step 103: The virtual robot calculates posture data according to the terminal coordinate data, controls the virtual robot to perform posture transformation according to the posture data, and obtains target interaction data for interacting with the virtual environment during the posture transformation process, Send the target interaction data to the force feedback controller.
接下来,控制上述虚拟机器人模拟上述末端坐标数据对应姿态,需要进行姿态变换,那么需要先通过上述末端坐标数据计算姿态数据,虚拟机器人再根据上述姿态数据进行姿态变换,获取再上述姿态变换过程中,上述虚拟机器人与所述虚拟环境进行交互的目标交互数据,完成对上述虚拟机器人的控制和姿态变化,将所述目标交互数据发送给力反馈控制器,便于接下来实现触觉交互。Next, the above-mentioned virtual robot is controlled to simulate the posture corresponding to the above-mentioned terminal coordinate data, and posture transformation needs to be performed. Then the posture data needs to be calculated through the above-mentioned terminal coordinate data. The virtual robot then performs posture transformation based on the above-mentioned posture data, and obtains the posture during the above-mentioned posture transformation process. , the target interaction data of the virtual robot interacting with the virtual environment is used to complete the control and attitude change of the virtual robot, and the target interaction data is sent to the force feedback controller to facilitate subsequent tactile interaction.
步骤104,所述力反馈控制器根据所述目标交互数据执行力反馈动作。Step 104: The force feedback controller performs a force feedback action according to the target interaction data.
接下来,上述力反馈控制器根据上述目标交互数据执行力反馈动作,完成双向的触觉交互,上述力反馈控制器可以提供多自由度的力反馈信息,给予操作者力触觉感知。Next, the above-mentioned force feedback controller performs force feedback actions according to the above-mentioned target interaction data to complete two-way tactile interaction. The above-mentioned force feedback controller can provide multi-degree-of-freedom force feedback information to give the operator force tactile perception.
通过应用本实施例的技术方案,通过机器人的物理实体数据准确的建立虚拟机器人,操作者操控力反馈控制器,控制虚拟机器人根据末端坐标数据进行姿态变换,获取姿态变换过程中与虚拟环境的目标交互数据,力反馈控制器根据所述目标交互数据执行力反馈动作,给操作者提供力触觉感知,实现了为操作者与虚拟机器人提供双向沉浸式触觉交互的目标,提高了与虚拟机器人进行交互的真实性。By applying the technical solution of this embodiment, a virtual robot is accurately established through the physical entity data of the robot. The operator controls the force feedback controller, controls the virtual robot to perform posture transformation according to the terminal coordinate data, and obtains the target of the virtual environment during the posture transformation process. Interaction data, the force feedback controller performs force feedback actions according to the target interaction data, provides the operator with force tactile perception, achieves the goal of providing two-way immersive tactile interaction between the operator and the virtual robot, and improves the interaction with the virtual robot. authenticity.
进一步的,作为上述实施例具体实施方式的细化和扩展,为了完整说明本实施例的具体实施过程,所述物理属性包括质量、模型尺寸和表面材质,所述目标交互数据包括碰撞目标交互数据和抓取目标交互数据,提供了另一种机器人虚拟建模与触觉控制方法,如图2所示,该方法包括:Further, as a refinement and expansion of the specific implementation of the above embodiment, in order to completely explain the specific implementation process of this embodiment, the physical attributes include mass, model size and surface material, and the target interaction data includes collision target interaction data. Interaction data with the grasping target provides another method of robot virtual modeling and tactile control, as shown in Figure 2. This method includes:
步骤201,根据所述机器人的型号数据、机械尺寸数据、关节数量数据以及运动范围数据,建立所述虚拟机器人的各部件虚拟模型,根据所述机器人的实际连接关系,组合所述各部件虚拟模型,形成所述虚拟机器人的虚拟三维模型,并绑定所述虚拟三维模型中各关节点的上下级关系。Step 201: Establish a virtual model of each component of the virtual robot based on the robot's model data, mechanical size data, joint number data, and motion range data, and combine the virtual models of each component according to the actual connection relationship of the robot. , forming a virtual three-dimensional model of the virtual robot, and binding the superior-subordinate relationship of each joint point in the virtual three-dimensional model.
在本申请实施例中,首先根据上述机器人的型号数据、机械尺寸数据、关节数量数据以及运动范围数据,建立上述虚拟机器人的各部件虚拟模型,其中,上述各部件虚拟模型包括底座模型、连杆模型、传感器模型以及前端工具模型等;接下来根据上述机器人的实际连接关系,将上述各部件虚拟模型进行组合,形成上述虚拟机器人的虚拟三维模型,并将其各关节点的上下级关系绑定。In the embodiment of the present application, firstly, a virtual model of each component of the above-mentioned virtual robot is established based on the model data, mechanical size data, joint number data and motion range data of the above-mentioned robot. The virtual model of each component includes a base model and a connecting rod. model, sensor model, front-end tool model, etc.; then, according to the actual connection relationship of the above-mentioned robot, the virtual models of the above-mentioned components are combined to form a virtual three-dimensional model of the above-mentioned virtual robot, and the superior-subordinate relationship of each joint point is bound .
步骤202,根据所述机器人的质量、模型尺寸和表面材质为所述绑定后的虚拟三维模型搭建刚体组件、碰撞体组件以及表面材质组件,建立虚拟机器人;建立力反馈控制器和所述虚拟机器人之间的连接。Step 202: Build a rigid body component, a collision body component and a surface material component for the bound virtual three-dimensional model according to the mass, model size and surface material of the robot to create a virtual robot; establish a force feedback controller and the virtual Connections between robots.
接下来,上述刚体组件根据上述机器人的质量确定,上述碰撞体组件根据上述机器人的模型尺寸确定,上述表面材质组件根据上述机器人的表面材质确定,根据上述机器人的质量为上述虚拟三维模型搭建刚体组件,根据上述机器人的模型尺寸为上述虚拟三维模型搭建碰撞体组件,根据上述机器人的表面材质为上述虚拟三维模型搭建表面材质组件,建立虚拟机器人,建立力反馈控制器和上述虚拟机器人之间的连接,通过增加刚体组件、碰撞体组件、表面材质组件赋予虚拟机器人触觉交互属性,提高了交互的真实性。Next, the above-mentioned rigid body component is determined according to the mass of the above-mentioned robot, the above-mentioned collision body component is determined according to the model size of the above-mentioned robot, the above-mentioned surface material component is determined according to the surface material of the above-mentioned robot, and a rigid body component is built for the above-mentioned virtual three-dimensional model based on the mass of the above-mentioned robot. , build a collision body component for the above-mentioned virtual three-dimensional model according to the model size of the above-mentioned robot, build a surface material component for the above-mentioned virtual three-dimensional model according to the surface material of the above-mentioned robot, establish a virtual robot, and establish a connection between the force feedback controller and the above-mentioned virtual robot. , by adding rigid body components, collision body components, and surface material components to give the virtual robot tactile interaction attributes, improving the authenticity of the interaction.
步骤203,操作者操作所述力反馈控制器,并将所述力反馈控制器的末端坐标数据发送给所述虚拟机器人。Step 203: The operator operates the force feedback controller and sends the end coordinate data of the force feedback controller to the virtual robot.
接下来,操作者操作上述力反馈控制器,并将上述力反馈控制器的末端坐标数据发送给上述虚拟机器人。Next, the operator operates the force feedback controller and sends the terminal coordinate data of the force feedback controller to the virtual robot.
步骤204,建立所述虚拟机器人的笛卡尔坐标空间,根据所述末端坐标数据在所述笛卡尔坐标空间建立所述虚拟机器人各关节的独立坐标系;根据所述虚拟机器人各关节的独立坐标系确定所述虚拟机器人相邻关节的变换矩阵,根据每个所述相邻关节的变换矩阵,依次计算所述虚拟机器人各关节的姿态信息,获得姿态数据。Step 204: Establish a Cartesian coordinate space of the virtual robot, and establish an independent coordinate system of each joint of the virtual robot in the Cartesian coordinate space according to the end coordinate data; according to the independent coordinate system of each joint of the virtual robot Determine the transformation matrices of adjacent joints of the virtual robot, calculate the posture information of each joint of the virtual robot in sequence according to the transformation matrix of each adjacent joint, and obtain posture data.
接下来,按照预设创建规则建立所述虚拟机器人的笛卡尔坐标空间,根据所述末端坐标数据在所述笛卡尔坐标空间建立所述虚拟机器人各关节的独立坐标系,其中,采用右手定则建立上述各关节的独立坐标系;根据所述虚拟机器人各关节的独立坐标系确定所述虚拟机器人相邻关节的变换矩阵为:Next, the Cartesian coordinate space of the virtual robot is established according to the preset creation rules, and the independent coordinate system of each joint of the virtual robot is established in the Cartesian coordinate space according to the end coordinate data, wherein the right-hand rule is used Establish the independent coordinate system of each joint of the above-mentioned joints; determine the transformation matrix of the adjacent joints of the virtual robot according to the independent coordinate system of each joint of the virtual robot as:
其中,i表示所述虚拟机器人中的第i个关节,表示第i-1个关节和第i个关节的变换矩阵,θi为第i个关节的关节角度变量,li-1表示第i-1个关节和第i个关节之间沿X轴的距离,di表示第i-1个关节和第i个关节之间沿Z轴的平移距离,αi-1表示第i-1个关节和第i个关节之间绕X轴的旋转角度;Where, i represents the i-th joint in the virtual robot, represents the transformation matrix of the i-1th joint and the i-th joint, θ i is the joint angle variable of the i-th joint, l i-1 represents the transformation matrix between the i-1th joint and the i-th joint along the X-axis Distance, d i represents the translation distance along the Z-axis between the i-1th joint and the i-th joint, α i-1 represents the rotation angle around the X-axis between the i-1th joint and the i-th joint;
再根据每个所述相邻关节的变换矩阵,依次计算所述虚拟机器人各关节的姿态信息,例如,机器人末端相对于关节1的姿态信息可计算为其中,Ti i+1表示第i个和第i+1个,两个相邻关节的变换矩阵,T1 End表示第1个关节与末端位置间的变换矩阵,获得姿态数据,通过计算相邻关节的变换矩阵,确定虚拟机器人的需要进行变换的姿态数据,为接下来完成触觉交互做准备。Then, based on the transformation matrix of each adjacent joint, the posture information of each joint of the virtual robot is calculated sequentially. For example, the posture information of the robot end relative to joint 1 can be calculated as Among them, T i i+1 represents the transformation matrix of the i-th and i+1-th two adjacent joints, and T 1 End represents the transformation matrix between the first joint and the end position. The attitude data is obtained by calculating the phase. The transformation matrix of adjacent joints determines the posture data of the virtual robot that needs to be transformed to prepare for the subsequent completion of tactile interaction.
步骤205,根据所述姿态数据控制所述虚拟机器人进行姿态变换,检测所述虚拟机器人在姿态变换过程中是否与所述虚拟环境发生接触,在发生接触时,获取碰撞接触位置数据和所接触虚拟环境的碰撞虚拟属性数据,将所述碰撞接触位置数据和所述碰撞虚拟属性数据作为碰撞目标交互数据,将所述碰撞目标交互数据发送给力反馈控制器。Step 205: Control the virtual robot to perform posture transformation according to the posture data, detect whether the virtual robot comes into contact with the virtual environment during the posture transformation process, and when contact occurs, obtain the collision contact position data and the contacted virtual environment. Collision virtual attribute data of the environment, the collision contact position data and the collision virtual attribute data are used as collision target interaction data, and the collision target interaction data is sent to the force feedback controller.
接下来,所述目标交互数据包括碰撞目标交互数据和抓取目标交互数据,根据上述姿态数据控制虚拟机器人进行姿态变换,检测上述虚拟机器人在姿态变换过程中是否与上述虚拟环境发生接触,其中,虚拟环境包括虚拟物体,虚拟机器人在姿态变换过程中可能与虚拟环境发生接触或与虚拟环境中的虚拟物体发生接触;在与虚拟环境或虚拟物体发生接触时,获取碰撞接触位置数据、以及所接触虚拟环境或所接触虚拟物体的碰撞虚拟属性数据,将上述碰撞接触位置数据和上述碰撞虚拟属性数据作为碰撞目标交互数据,将上述碰撞目标交互数据发送给力反馈控制器,通过获取虚拟机器人在姿态变换过程中的目标交互数据,并将目标交互数据发送给力反馈控制器,实现了与虚拟机器人之间的数据交互,便于接下来实现触觉交互。Next, the target interaction data includes collision target interaction data and grasping target interaction data. The virtual robot is controlled to perform posture transformation according to the above posture data, and whether the above virtual robot comes into contact with the above virtual environment during the posture transformation process is detected, wherein, The virtual environment includes virtual objects. The virtual robot may come into contact with the virtual environment or with virtual objects in the virtual environment during the posture transformation process; when it comes into contact with the virtual environment or virtual objects, the collision contact position data and the contact location data are obtained. The collision virtual attribute data of the virtual environment or the contacted virtual object, the above collision contact position data and the above collision virtual attribute data are used as the collision target interaction data, and the above collision target interaction data is sent to the force feedback controller. The target interaction data in the process is sent to the force feedback controller, which realizes data interaction with the virtual robot and facilitates the subsequent tactile interaction.
步骤206,若所述操作者在所述虚拟机器人与所述虚拟环境接触的同时按下抓取按钮,则控制所述虚拟机器人执行抓取动作,获取抓取接触位置数据和抓取虚拟属性数据,将所述抓取接触位置数据和所述抓取虚拟属性数据作为抓取目标交互数据,将所述抓取目标交互数据发送给力反馈控制器;若所述操作者松开所述抓取按钮,则控制所述虚拟机器人执行释放动作。Step 206: If the operator presses the grabbing button while the virtual robot is in contact with the virtual environment, the virtual robot is controlled to perform a grabbing action, and the grabbing contact position data and the grabbing virtual attribute data are obtained. , use the grabbing contact position data and the grabbing virtual attribute data as grabbing target interaction data, and send the grabbing target interaction data to the force feedback controller; if the operator releases the grabbing button , then the virtual robot is controlled to perform the release action.
接下来,上述虚拟环境中包括虚拟物体,当操作者在虚拟机器人与虚拟物体接触的同时按下抓取按钮,触发抓取功能,控制虚拟机器人执行抓取动作,获取抓取接触位置数据和抓取虚拟属性数据,将上述抓取接触位置数据和上述抓取虚拟属性数据作为抓取目标交互数据,将上述抓取目标交互数据发送给力反馈控制器,当操作者松开按钮时,触发释放功能,控制所述虚拟机器人执行释放动作,其中,可以通过在所接触位置添加固定关节组件,获取上述抓取虚拟属性数据,固定关节组件用于连接虚拟机器人与虚拟物体,模拟抓取效果,相应的,当触发释放功能时,删除上述固定关节组件和上述抓取虚拟属性数据,结束抓取动作,通过操作者操作控制虚拟机器人执行对应姿态变换的动作,获取变换中的目标交互数据发送给力反馈控制器,并可以通过建立固定关节组件,模拟了抓取效果,提高了交互的真实性。Next, the above-mentioned virtual environment includes virtual objects. When the operator presses the grabbing button while the virtual robot is in contact with the virtual object, the grabbing function is triggered, the virtual robot is controlled to perform the grabbing action, and the grabbing contact position data and grabbing Get the virtual attribute data, use the above-mentioned grasping contact position data and the above-mentioned grasping virtual attribute data as the grasping target interaction data, send the above-mentioned grasping target interaction data to the force feedback controller, and when the operator releases the button, the release function is triggered , controlling the virtual robot to perform a release action, in which the above-mentioned grabbing virtual attribute data can be obtained by adding a fixed joint component at the contact position. The fixed joint component is used to connect the virtual robot and the virtual object to simulate the grabbing effect, correspondingly , when the release function is triggered, delete the above-mentioned fixed joint components and the above-mentioned grabbing virtual attribute data, end the grabbing action, control the virtual robot to perform the action corresponding to the posture transformation through the operator's operation, obtain the target interaction data during transformation and send it to the force feedback control It can simulate the grasping effect by establishing fixed joint components and improve the authenticity of interaction.
步骤207,所述力反馈控制器根据所述目标交互数据执行力反馈动作。Step 207: The force feedback controller performs a force feedback action according to the target interaction data.
接下来,上述力反馈控制器根据上述目标交互数据执行力反馈动作,给予操作者力触觉感知,实现与虚拟机器人的触觉交互。Next, the above-mentioned force feedback controller performs a force feedback action according to the above-mentioned target interaction data, giving the operator force tactile perception and realizing tactile interaction with the virtual robot.
可选地,上述步骤201中,所述绑定所述虚拟三维模型中各关节点的上下级关系,包括:将所述底座模型设置为父节点,并将第一连杆模型设置为所述底座模型的子节点;根据所述机器人的实际连接关系的预设前后顺序,依次将每一个连杆模型设置为前一连杆模型的子节点;将所述传感器模型和所述前端工具模型设置为最后一根连杆模型的子节点。Optionally, in the above step 201, binding the superior-subordinate relationship of each joint point in the virtual three-dimensional model includes: setting the base model as the parent node, and setting the first link model as the Child nodes of the base model; according to the preset sequence of the actual connection relationship of the robot, each link model is set as a child node of the previous link model; the sensor model and the front-end tool model are set is the child node of the last connecting rod model.
在本申请上述实施例中,所述连杆模型包括多个连杆模型,并通过预设前后顺序进行区分,将上述底座模型设置为父节点,并将第一连杆模型设置为上述底座模型的子节点,根据上述机器人的实际连接关系的预设前后顺序,依次将每一个连杆模型设置为前一连杆模型的子节点,将上述传感器模型和上述前端工具模型设置为最后一根连杆模型的子节点,完成各关节点的上下级关系绑定,便于实现虚拟机器人控制。In the above-mentioned embodiment of the present application, the connecting rod model includes multiple connecting rod models, and they are distinguished by a preset sequence. The above-mentioned base model is set as the parent node, and the first connecting rod model is set as the above-mentioned base model. sub-node, according to the preset order of the actual connection relationship of the above-mentioned robot, each link model is set as a child node of the previous link model in turn, and the above-mentioned sensor model and the above-mentioned front-end tool model are set as the last link The child nodes of the rod model complete the binding of the superior and subordinate relationships of each joint point to facilitate the realization of virtual robot control.
可选地,上述力反馈动作包括重力反馈动作、弹性力反馈动作、粘性力反馈动作以及摩擦力反馈动作;上述步骤207中“所述力反馈控制器根据所述目标交互数据执行力反馈动作”包括:所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的质量,执行所述重力反馈动作;所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的坚硬程度数据,执行所述弹性力反馈动作;所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粘性程度数据,执行所述粘性力反馈动作;所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粗糙程度数据,执行所述摩擦力反馈动作。Optionally, the above force feedback action includes gravity feedback action, elastic force feedback action, viscous force feedback action and friction force feedback action; in the above step 207, "the force feedback controller executes the force feedback action according to the target interaction data" The method includes: the force feedback controller performs the gravity feedback action according to the contact position data and the quality of the contacted virtual object; the force feedback controller performs the gravity feedback action according to the contact position data and the contacted virtual object. The force feedback controller performs the viscous force feedback action based on the contact position data and the viscosity data of the contacted virtual object; the force feedback control The device performs the friction feedback action based on the contact position data and the roughness data of the contacted virtual object.
在本申请上述实施例中,上述力反馈控制器根据上述接触位置数据和上述所接触虚拟物体的质量,执行上述重力反馈动作,例如根据上述接触位置数据和上述所接触虚拟物体的质量向下方增加扭矩,模拟提起物体时的重力反馈效果;上述力反馈控制器根据上述接触位置数据和上述所接触虚拟物体的坚硬程度数据,执行上述弹性力反馈动作,例如据上述接触位置数据和上述所接触虚拟物体的坚硬程度数据向所接触方向增加扭矩,模拟物体表面的弹性力效果;上述力反馈控制器根据上述接触位置数据和上述所接触虚拟物体的粘性程度数据,执行上述粘性力反馈动作,例如根据上述接触位置数据和上述所接触虚拟物体的粘性程度数据向所接触方向的相反方向增加扭矩,模拟物体表面的弹性力效果;上述力反馈控制器根据上述接触位置数据和上述所接触虚拟物体的粗糙程度数据,执行上述摩擦力反馈动作,例如根据上述接触位置数据和上述所接触虚拟物体的粗糙程度数据向垂直于所接触方向增加扭矩,模拟物体表面的摩擦力效果,使操作者通过力反馈控制器感知到触觉效果,提高与机器人进行交互的真实性。In the above-mentioned embodiment of the present application, the above-mentioned force feedback controller performs the above-mentioned gravity feedback action according to the above-mentioned contact position data and the above-mentioned mass of the contacted virtual object, for example, according to the above-mentioned contact position data and the above-mentioned mass of the contacted virtual object, the force feedback controller performs the above-mentioned gravity feedback action. Torque simulates the gravity feedback effect when lifting an object; the above-mentioned force feedback controller performs the above-mentioned elastic force feedback action based on the above-mentioned contact position data and the above-mentioned hardness data of the contacted virtual object. The hardness data of the object increases torque in the direction of contact, simulating the elastic force effect on the surface of the object; the above-mentioned force feedback controller performs the above-mentioned viscous force feedback action based on the above-mentioned contact position data and the above-mentioned viscosity data of the contacted virtual object, for example, according to The above-mentioned contact position data and the above-mentioned viscosity data of the contacted virtual object increase torque in the opposite direction of the contact direction to simulate the elastic force effect of the object surface; the above-mentioned force feedback controller is based on the above-mentioned contact position data and the above-mentioned roughness of the contacted virtual object. Degree data, perform the above-mentioned friction feedback action, for example, according to the above-mentioned contact position data and the above-mentioned roughness data of the contacted virtual object, add torque to the direction perpendicular to the contact, simulate the friction effect on the surface of the object, and enable the operator to control it through force feedback The device senses the tactile effect, improving the authenticity of interacting with the robot.
需要说明的是,上述虚拟属性数据包括刚体组件参数、碰撞体组件参数以及表面材质组件参数;所述刚体组件参数从所接触虚拟物体的刚体组件读取,由所接触虚拟物体质量确定;所述碰撞体组件参数从所接触虚拟物体的碰撞体组件读取,由所接触虚拟物体的模型轮廓确定;所述表面材质组件参数参数从所接触虚拟物体的表面材质组件读取,由所接触虚拟物体表面的坚硬程度数据、粘性程度数据以及粗糙程度数据确定。It should be noted that the above-mentioned virtual attribute data includes rigid body component parameters, collision body component parameters and surface material component parameters; the rigid body component parameters are read from the rigid body component of the contacted virtual object and are determined by the quality of the contacted virtual object; The collider component parameters are read from the collider component of the touched virtual object and determined by the model outline of the touched virtual object; the surface material component parameter parameters are read from the surface material component of the touched virtual object and determined by the touched virtual object. The hardness data, viscosity data and roughness data of the surface are determined.
在本申请的上述实施例中,上述刚体组件参数由所接触虚拟物体的质量决定,并从所接触虚拟物体的刚体组件读取;上述碰撞体组件参数由所接触虚拟物体的模型轮廓决定,并从所接触虚拟物体的碰撞体组件读取;上述表面材质组件参数由所接触虚拟物体表面的坚硬程度数据、粘性程度数据以及粗糙程度数据决定。In the above-mentioned embodiments of the present application, the above-mentioned rigid body component parameters are determined by the mass of the contacted virtual object and are read from the rigid body component of the contacted virtual object; the above-mentioned collision body component parameters are determined by the model outline of the contacted virtual object, and Read from the collider component of the virtual object in contact; the above surface material component parameters are determined by the hardness data, viscosity data and roughness data of the surface of the virtual object in contact.
通过应用本实施例的技术方案,通过实体机器人建立虚拟机器人,又通过增加刚体组件、碰撞体组件、表面材质组件赋予虚拟机器人触觉交互属性,并在实时触觉控制虚拟机器人的姿态变换时,获取在虚拟环境中的目标交互数据,为操作者提供力触觉反馈为操作者与虚拟机器人提供了双向沉浸式的触觉交互,提高了交互的真实性。By applying the technical solution of this embodiment, a virtual robot is created through a physical robot, and the virtual robot is given tactile interaction attributes by adding rigid body components, collision body components, and surface material components, and when the posture transformation of the virtual robot is controlled by real-time tactility, the tactile interaction properties are obtained. The target interaction data in the virtual environment provides force tactile feedback for the operator and provides two-way immersive tactile interaction between the operator and the virtual robot, improving the authenticity of the interaction.
进一步的,作为图1方法的具体实现,本申请实施例提供了一种机器人虚拟建模与触觉控制装置,如图3所示,该装置包括:Further, as a specific implementation of the method in Figure 1, an embodiment of the present application provides a robot virtual modeling and tactile control device. As shown in Figure 3, the device includes:
搭建模块,用于根据机器人的物理实体数据在虚拟环境中建立虚拟机器人,建立力反馈控制器和所述虚拟机器人之间的连接;A building module for establishing a virtual robot in a virtual environment based on the physical entity data of the robot, and establishing a connection between the force feedback controller and the virtual robot;
操作模块,用于操作者操作所述力反馈控制器,并将所述力反馈控制器的末端坐标数据发送给所述虚拟机器人;An operation module for the operator to operate the force feedback controller and send the end coordinate data of the force feedback controller to the virtual robot;
交互模块,用于所述虚拟机器人根据所述末端坐标数据计算姿态数据,根据所述姿态数据控制所述虚拟机器人进行姿态变换,获取所述姿态变换过程中与所述虚拟环境进行交互的目标交互数据,将所述目标交互数据发送给力反馈控制器;An interaction module, used for the virtual robot to calculate posture data according to the terminal coordinate data, control the virtual robot to perform posture transformation according to the posture data, and obtain the target interaction with the virtual environment during the posture transformation process. data, sending the target interaction data to the force feedback controller;
反馈模块,用于所述力反馈控制器根据所述目标交互数据执行力反馈动作。A feedback module is used for the force feedback controller to perform force feedback actions according to the target interaction data.
可选地,所述搭建模块,还用于:Optionally, the building module is also used to:
根据所述机器人的型号数据、机械尺寸数据、关节数量数据以及运动范围数据,建立所述虚拟机器人的各部件虚拟模型,根据所述机器人的实际连接关系,组合所述各部件虚拟模型,形成所述虚拟机器人的虚拟三维模型,并绑定所述虚拟三维模型中各关节点的上下级关系;According to the model data, mechanical size data, joint number data and motion range data of the robot, a virtual model of each component of the virtual robot is established. According to the actual connection relationship of the robot, the virtual models of each component are combined to form the virtual model of each component. Describe a virtual three-dimensional model of the virtual robot, and bind the superior-subordinate relationship of each joint point in the virtual three-dimensional model;
根据所述机器人的物理属性和绑定后的虚拟三维模型建立虚拟机器人,其中,所述物理属性包括质量、模型尺寸和表面材质,所述各部件虚拟模型包括底座模型、连杆模型、传感器模型以及前端工具模型。A virtual robot is established according to the physical attributes of the robot and the bound virtual three-dimensional model. The physical attributes include mass, model size and surface material. The virtual models of each component include a base model, a connecting rod model, and a sensor model. and front-end tool models.
可选地,所述搭建模块,还用于:Optionally, the building module is also used to:
将所述底座模型设置为父节点,并将第一连杆模型设置为所述底座模型的子节点;Set the base model as a parent node, and set the first link model as a child node of the base model;
根据所述机器人的实际连接关系的预设前后顺序,依次将每一个连杆模型设置为前一连杆模型的子节点;According to the preset sequence of the actual connection relationship of the robot, each link model is set as a child node of the previous link model in turn;
将所述传感器模型和所述前端工具模型设置为最后一根连杆模型的子节点。The sensor model and the front-end tool model are set as child nodes of the last connecting rod model.
可选地,所述搭建模块,还用于:Optionally, the building module is also used to:
根据所述机器人的质量、模型尺寸和表面材质为所述绑定后的虚拟三维模型搭建刚体组件、碰撞体组件以及表面材质组件,建立虚拟机器人;Build a rigid body component, a collision body component and a surface material component for the bound virtual three-dimensional model according to the mass, model size and surface material of the robot to establish a virtual robot;
其中,所述刚体组件根据所述机器人的质量确定,所述碰撞体组件根据所述机器人的模型尺寸确定,所述表面材质组件根据所述机器人的表面材质属性确定。Wherein, the rigid body component is determined based on the mass of the robot, the collision body component is determined based on the model size of the robot, and the surface material component is determined based on the surface material properties of the robot.
可选地,所述交互模块,还用于:Optionally, the interactive module is also used to:
建立所述虚拟机器人的笛卡尔坐标空间,根据所述末端坐标数据在所述笛卡尔坐标空间建立所述虚拟机器人各关节的独立坐标系;Establishing a Cartesian coordinate space of the virtual robot, and establishing an independent coordinate system for each joint of the virtual robot in the Cartesian coordinate space according to the end coordinate data;
根据所述虚拟机器人各关节的独立坐标系确定所述虚拟机器人相邻关节的变换矩阵;Determine the transformation matrix of adjacent joints of the virtual robot according to the independent coordinate system of each joint of the virtual robot;
根据每个所述相邻关节的变换矩阵,依次计算所述虚拟机器人各关节的姿态信息,获得姿态数据。According to the transformation matrix of each adjacent joint, the posture information of each joint of the virtual robot is calculated sequentially to obtain posture data.
可选地,所述交互模块,还用于:Optionally, the interactive module is also used to:
检测所述虚拟机器人在姿态变换过程中是否与所述虚拟环境发生接触,在发生接触时,获取碰撞接触位置数据和所接触虚拟环境的碰撞虚拟属性数据,将所述碰撞接触位置数据和所述碰撞虚拟属性数据作为碰撞目标交互数据,将所述碰撞目标交互数据发送给力反馈控制器,其中,所述虚拟环境中包括虚拟物体;Detect whether the virtual robot comes into contact with the virtual environment during the posture transformation process. When contact occurs, obtain the collision contact position data and the collision virtual attribute data of the contacted virtual environment, and combine the collision contact position data and the collision virtual attribute data of the virtual environment. The collision virtual attribute data is used as the collision target interaction data, and the collision target interaction data is sent to the force feedback controller, wherein the virtual environment includes virtual objects;
若所述操作者在所述虚拟机器人与所述虚拟物体接触的同时按下抓取按钮,则控制所述虚拟机器人执行抓取动作,获取抓取接触位置数据和抓取虚拟属性数据,将所述抓取接触位置数据和所述抓取虚拟属性数据作为抓取目标交互数据,将所述抓取目标交互数据发送给力反馈控制器;若所述操作者松开所述抓取按钮,则控制所述虚拟机器人执行释放动作。If the operator presses the grasping button while the virtual robot is in contact with the virtual object, the virtual robot is controlled to perform a grasping action, the grasping contact position data and the grasping virtual attribute data are obtained, and all the objects are captured. The grabbing contact position data and the grabbing virtual attribute data are used as grabbing target interaction data, and the grabbing target interaction data is sent to the force feedback controller; if the operator releases the grabbing button, the control The virtual robot performs a release action.
可选地,所述虚拟属性数据包括刚体组件参数、碰撞体组件参数以及表面材质组件参数;Optionally, the virtual attribute data includes rigid body component parameters, collision body component parameters and surface material component parameters;
其中,所述刚体组件参数从所接触虚拟物体的刚体组件读取,由所接触虚拟物体质量确定;所述碰撞体组件参数从所接触虚拟物体的碰撞体组件读取,由所接触虚拟物体的模型轮廓确定;所述表面材质组件参数从所接触虚拟物体的表面材质组件读取,由所接触虚拟物体表面的坚硬程度数据、粘性程度数据以及粗糙程度数据确定。Wherein, the rigid body component parameters are read from the rigid body component of the contacted virtual object and are determined by the quality of the contacted virtual object; the collider component parameters are read from the collider component of the contacted virtual object and are determined by the quality of the contacted virtual object. The model outline is determined; the surface material component parameters are read from the surface material component of the virtual object in contact, and determined by the hardness data, viscosity data and roughness data of the surface of the virtual object in contact.
可选地,所述反馈模块,还用于:Optionally, the feedback module is also used to:
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的质量,执行所述重力反馈动作;The force feedback controller performs the gravity feedback action according to the contact position data and the quality of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的坚硬程度数据,执行所述弹性力反馈动作;The force feedback controller performs the elastic force feedback action according to the contact position data and the hardness data of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粘性程度数据,执行所述粘性力反馈动作;The force feedback controller performs the viscous force feedback action according to the contact position data and the viscosity degree data of the contacted virtual object;
所述力反馈控制器根据所述接触位置数据和所述所接触虚拟物体的粗糙程度数据,执行所述摩擦力反馈动作。The force feedback controller performs the friction force feedback action according to the contact position data and the roughness data of the contacted virtual object.
需要说明的是,本申请实施例提供的一种机器人虚拟建模与触觉控制装置所涉及各功能单元的其他相应描述,可以参考图1至图2方法中的对应描述,在此不再赘述。It should be noted that for other corresponding descriptions of the functional units involved in the robot virtual modeling and tactile control device provided by the embodiments of the present application, please refer to the corresponding descriptions in the method of Figures 1 to 2, and will not be described again here.
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到本申请可以借助软件加必要的通用硬件平台的方式来实现,也可以通过硬件实现,通过机器人的物理实体数据准确的建立虚拟机器人,操作者操控力反馈控制器,控制虚拟机器人根据末端坐标数据进行姿态变换,获取姿态变换过程中与虚拟环境的目标交互数据,力反馈控制器根据所述目标交互数据执行力反馈动作,给操作者提供力触觉感知,实现了为操作者与虚拟机器人提供双向沉浸式触觉交互的目标,提高了与虚拟机器人进行交互的真实性。Through the description of the above embodiments, those skilled in the art can clearly understand that the present application can be implemented by means of software plus the necessary general hardware platform, or can also be implemented by hardware, and the virtual entity can be accurately established through the physical entity data of the robot. For the robot, the operator controls the force feedback controller, controls the virtual robot to perform posture transformation according to the terminal coordinate data, and obtains the target interaction data with the virtual environment during the posture transformation process. The force feedback controller performs force feedback actions based on the target interaction data, giving The operator provides force tactile perception, achieving the goal of providing two-way immersive tactile interaction between the operator and the virtual robot, and improving the authenticity of the interaction with the virtual robot.
本领域技术人员可以理解附图只是一个优选实施场景的示意图,附图中的模块或流程并不一定是实施本申请所必须的。本领域技术人员可以理解实施场景中的装置中的模块可以按照实施场景描述进行分布于实施场景的装置中,也可以进行相应变化位于不同于本实施场景的一个或多个装置中。上述实施场景的模块可以合并为一个模块,也可以进一步拆分成多个子模块。Those skilled in the art can understand that the accompanying drawing is only a schematic diagram of a preferred implementation scenario, and the modules or processes in the accompanying drawing are not necessarily necessary for implementing the present application. Those skilled in the art can understand that the modules in the devices in the implementation scenario can be distributed in the devices in the implementation scenario according to the description of the implementation scenario, or can be correspondingly changed and located in one or more devices different from the implementation scenario. The modules of the above implementation scenarios can be combined into one module or further split into multiple sub-modules.
上述本申请序号仅仅为了描述,不代表实施场景的优劣。以上公开的仅为本申请的几个具体实施场景,但是,本申请并非局限于此,任何本领域的技术人员能思之的变化都应落入本申请的保护范围。The above serial numbers of this application are only for description and do not represent the advantages and disadvantages of the implementation scenarios. What is disclosed above are only a few specific implementation scenarios of the present application. However, the present application is not limited thereto. Any changes that can be thought of by those skilled in the art should fall within the protection scope of the present application.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310905781.8A CN117245648A (en) | 2023-07-21 | 2023-07-21 | A robot virtual modeling and tactile control method and device |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310905781.8A CN117245648A (en) | 2023-07-21 | 2023-07-21 | A robot virtual modeling and tactile control method and device |
Publications (1)
Publication Number | Publication Date |
---|---|
CN117245648A true CN117245648A (en) | 2023-12-19 |
Family
ID=89135777
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310905781.8A Pending CN117245648A (en) | 2023-07-21 | 2023-07-21 | A robot virtual modeling and tactile control method and device |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN117245648A (en) |
-
2023
- 2023-07-21 CN CN202310905781.8A patent/CN117245648A/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Qian et al. | Manipulation task simulation using ROS and Gazebo | |
JP7324932B2 (en) | dynamic planning controller | |
Wang et al. | Real-time process-level digital twin for collaborative human-robot construction work | |
CN108241339A (en) | Motion solution and configuration control method of humanoid manipulator | |
Manring et al. | Augmented reality for interactive robot control | |
CN104470687A (en) | Robot simulator, robot teaching device and robot teaching method | |
Valenzuela-Urrutia et al. | Virtual reality-based time-delayed haptic teleoperation using point cloud data | |
CN114760458B (en) | Method for synchronizing tracks of virtual camera and real camera of high-reality augmented reality studio | |
Andaluz et al. | Transparency of a bilateral tele-operation scheme of a mobile manipulator robot | |
Manou et al. | Off-line programming of an industrial robot in a virtual reality environment | |
Jen et al. | VR-Based robot programming and simulation system for an industrial robot | |
Safaric et al. | Control of robot arm with virtual environment via the internet | |
Buzjak et al. | Towards immersive designing of production processes using virtual reality techniques | |
Ozakyol et al. | Advanced robotics analysis toolbox for kinematic and dynamic design and analysis of high‐DOF redundant serial manipulators | |
Nandikolla et al. | Teleoperation Robot Control of a Hybrid EEG‐Based BCI Arm Manipulator Using ROS | |
JPS6179589A (en) | Operating device for robot | |
Minoufekr et al. | Modelling of CNC Machine Tools for Augmented Reality Assistance Applications using Microsoft Hololens. | |
Hurtado et al. | Work-in-Progress: Virtual Reality System for training on the operation and programing of a Collaborative Robot | |
Faulring et al. | Haptic display of constrained dynamic systems via admittance displays | |
Deng et al. | A motion sensing-based framework for robotic manipulation | |
CN117245648A (en) | A robot virtual modeling and tactile control method and device | |
Sunil et al. | WebROBOT: Internet based robotic assembly planning system | |
Su et al. | Effective manipulation for industrial robot manipulators based on tablet PC | |
US12070857B2 (en) | Robot programming | |
Naskar et al. | Development of a digital twin interface for a collaborative robot |
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 |