WO2024055369A1 - 送餐机器人速度和位置的双工作模式切换方法及装置 - Google Patents

送餐机器人速度和位置的双工作模式切换方法及装置 Download PDF

Info

Publication number
WO2024055369A1
WO2024055369A1 PCT/CN2022/122970 CN2022122970W WO2024055369A1 WO 2024055369 A1 WO2024055369 A1 WO 2024055369A1 CN 2022122970 W CN2022122970 W CN 2022122970W WO 2024055369 A1 WO2024055369 A1 WO 2024055369A1
Authority
WO
WIPO (PCT)
Prior art keywords
delivery robot
food delivery
speed
encoder
mode
Prior art date
Application number
PCT/CN2022/122970
Other languages
English (en)
French (fr)
Inventor
宦键
许仁仁
魏海峰
王浩陈
Original Assignee
江苏科技大学
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 江苏科技大学 filed Critical 江苏科技大学
Publication of WO2024055369A1 publication Critical patent/WO2024055369A1/zh

Links

Images

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
    • 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/1656—Programme controls characterised by programming, planning systems for manipulators
    • B25J9/1664—Programme controls characterised by programming, planning systems for manipulators characterised by motion, path, trajectory planning
    • 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/1679—Programme controls characterised by the tasks executed

Definitions

  • the invention relates to the technical field of servo motor control, and in particular to a dual working mode switching method and device for the speed and position of a food delivery robot.
  • Food delivery robots have the advantages of saving manpower and adding a sense of technology. Therefore, food delivery robots are increasingly used in modern restaurants.
  • the entire walking structure of the food delivery robot is realized by a servo motor equipped with a servo system. Since the motion control part of the entire servo control system is included in the servo driver, a flexible control method can be selected. However, traditional servo control uses a single control mode. Switching the control mode from the speed loop to the position loop may re-initialize the parameters, causing the motor to stall, making the switch more difficult.
  • embodiments of the present invention provide a dual working mode switching method and device for the speed and position of a food delivery robot to solve the problem that in the prior art, the food delivery robot adopts a single control mode and switches from the speed loop to the position loop. It may cause the motor to stall, causing the food delivery robot to be inflexible in switching working modes.
  • Embodiments of the present invention provide a dual working mode switching method for the speed and position of a food delivery robot, including:
  • the rotational speed signal output by the servo motor that controls the food delivery robot is converted into a pulse signal through the encoder, and then the pulse signal is input to the servo driver to Control the servo motor to switch from speed mode to position mode.
  • the encoder uses A/B signal format.
  • f represents the pulse frequency
  • C represents the number of encoder lines
  • n represents the motor speed
  • M 0 represents the number of circles
  • L represents the distance between the food delivery robot and the closest target object
  • r represents the radius of the motor
  • Z represents the total number of pulses.
  • the pulse signal output by the encoder changes from dense to sparse.
  • the pulse signal output by the encoder is adjusted in real time.
  • Embodiments of the present invention also provide a dual working mode switching device for the speed and position of a food delivery robot.
  • the aforementioned dual working mode switching method for the speed and position of a food delivery robot includes:
  • the tracking system is connected to the motion controller.
  • the tracking system is used to obtain the operating trajectory signal of the food delivery robot; the tracking system is also used to compare the operating trajectory signal with the preset operating trajectory;
  • the vision system is connected to the motion controller.
  • the vision system is used to determine whether the obstacles encountered by the food delivery robot are target objects;
  • a radar system is connected to the motion controller.
  • the radar system is used to obtain the position information of the food delivery robot and the distance between the food delivery robot and the target object;
  • the motion controller includes servo motors, servo drives and encoders; the motion controller is used to switch between speed mode and position mode; among them, the switching between speed mode and position mode includes: when the food delivery robot and the closest target object When the distance reaches the preset value, the speed signal output by the servo motor that controls the food delivery robot is converted into a pulse signal through the encoder, and then the pulse signal is input to the servo driver to control the servo motor and realize switching from speed mode to position mode.
  • it also includes: a first voltage comparator and a second voltage comparator, respectively installed at the output end of the encoder; the first voltage comparator and the second voltage comparator output A/B square wave signals.
  • the embodiment of the present invention provides a dual working mode switching method for the speed and position of a food delivery robot.
  • the speed signal of the servo motor is converted into a pulse signal through an encoder and input to the servo driver, thereby improving the switching efficiency of the speed/position mode. , so that these two working modes are compatible with each other and can be converted flexibly.
  • the embodiment of the present invention provides a dual working mode switching method for the speed and position of a food delivery robot, which uses multiple control systems to accurately control the robot to ensure that the robot can reach the target object safely and on time according to the set path.
  • Figure 1 shows a flow chart of a dual working mode switching method for the speed and position of a food delivery robot in Embodiment 1 of the present invention
  • Figure 2 shows an operation schematic diagram of a dual working mode switching method for the speed and position of a food delivery robot in Embodiment 1 of the present invention
  • Figure 3 shows a structural diagram of a dual working mode switching device for the speed and position of a food delivery robot in Embodiment 2 of the present invention
  • Figure 4 shows a motion controller structural diagram of a dual working mode switching device for speed and position of a food delivery robot in Embodiment 2 of the present invention.
  • Embodiments of the present invention provide a dual working mode switching method for the speed and position of a food delivery robot, as shown in Figures 1 and 2, including:
  • Step S10 Obtain the running trajectory signal of the food delivery robot to confirm that the food delivery robot is on the preset running trajectory.
  • the operating trajectory of the food delivery robot is first confirmed to ensure that the food delivery robot is on the correct operating trajectory.
  • Step S20 when the distance between the food delivery robot and the closest target object reaches a preset value, the rotational speed signal output by the servo motor that controls the food delivery robot is converted into a pulse signal through the encoder, and then the pulse signal is input to the servo driver to control the servo motor to switch from speed mode to position mode.
  • this embodiment converts the motor speed signal into a pulse signal through the encoder and inputs it to the servo driver to realize the speed control. Switching from mode to position mode improves the switching efficiency of speed/position mode, making the two working modes compatible with each other and allowing flexible conversion.
  • it also includes:
  • the distance between the food delivery robot and the closest target object is used as the judgment condition for mode switching.
  • the distance between the food delivery robot and the target object reaches the preset value, Execute switching from speed mode to position mode.
  • the encoder adopts A/B signal format.
  • it also includes:
  • f represents the pulse frequency
  • C represents the number of encoder lines
  • n represents the motor speed
  • M 0 represents the number of circles
  • L represents the distance between the food delivery robot and the closest target object
  • r represents the radius of the motor
  • Z represents the total number of pulses.
  • the encoder inputs a pulse to the servo driver, and the servo motor steps forward a certain distance. After the last pulse is input, the motor is in a stopped state, that is, the robot reaches the target object and stops moving.
  • the pulse signal output by the encoder changes regularly from dense to sparse.
  • the motor speed change is set to decrease at a constant speed. Then the corresponding pulse signal change is a process from dense to sparse, thereby realizing the robot working mode from speed mode to Smooth switching of location modes.
  • the pulse signal output by the encoder is adjusted in real time.
  • the traveling speed and real-time position of the food delivery robot are monitored and the pulse output is adjusted to avoid the situation where the food delivery robot fails to stop at a predetermined position or hits a target object due to other reasons.
  • the embodiment of the present invention provides a dual working mode switching method for the speed and position of a food delivery robot, which uses multiple control systems to accurately control the robot to ensure that the robot can reach the target object safely and on time according to the set path.
  • the embodiment of the present invention provides a dual working mode switching device for the speed and position of a food delivery robot.
  • the dual working mode switching method for the speed and position of the food delivery robot in Embodiment 1 is applied, as shown in Figures 3 and 4, including : Tracking system 1, motion controller 2, vision system 3 and radar system 4, among which: tracking system 1 is connected to motion controller 2, tracking system 1 is used to obtain the running trajectory signal of the food delivery robot; tracking system 1 is also used to compare the running trajectory signal with the preset running trajectory; the vision system 3 is connected to the motion controller 2, and the vision system 3 is used to determine whether the obstacles encountered by the food delivery robot are target objects; the radar system 4 is connected with the motion control 2 is connected, and the radar system 4 is used to obtain the position information of the food delivery robot and the distance between the food delivery robot and the target object; the motion controller 2 includes a servo motor 201, a servo driver 202 and an encoder 203; the motion controller 2 uses To perform switching between speed mode and position mode; among which, switching between speed mode
  • the servo driver is connected to the servo motor and is used to control the working mode of the servo motor; the servo motor is connected to the encoder and is used to convert the rotation speed signal of the servo motor into a pulse signal when the mode is switched; the encoder is connected to the servo motor.
  • the driver is connected to input the pulse signal output by the encoder to the servo driver to achieve switching of speed and position working modes. Since in the servo control system, switching between speed mode and position mode will cause the problem of motor shutdown, this embodiment converts the motor speed signal into a pulse signal through the encoder and inputs it to the servo driver to realize switching from speed mode to position mode. , improves the switching efficiency of speed/position mode, making the two working modes compatible with each other and flexibly switching.
  • the embodiment of the present invention provides a dual working mode switching method for the speed and position of a food delivery robot, which uses multiple control systems to accurately control the robot to ensure that the robot can reach the target object safely and on time according to the set path.
  • it also includes: a first voltage comparator and a second voltage comparator, respectively installed at the output end of the encoder; the first voltage comparator and the second voltage comparator output A/B square wave signals. .
  • the A/B square wave signal output of the encoder is realized through two voltage comparators.
  • embodiments of the present invention provide a dual working mode switching method for the speed and position of a food delivery robot.
  • the speed signal of the servo motor is converted into a pulse signal through an encoder and input to the servo driver, thereby improving the speed/position mode.
  • the switching efficiency is high, so that the two working modes are compatible with each other and can be switched flexibly.
  • embodiments of the present invention provide a dual working mode switching method for the speed and position of a food delivery robot, which uses multiple control systems to accurately control the robot to ensure that the robot can reach the target object safely and on time according to the set path.

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

一种送餐机器人速度和位置的双工作模式切换方法及装置，其中方法包括：获取送餐机器人的运行轨迹信号，以确认送餐机器人在预设运行轨迹上(S10)；当送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制送餐机器人的伺服电机输出的转速信号通过编码器转换为脉冲信号，再将脉冲信号输入到伺服驱动器，以控制伺服电机，实现速度模式到位置模式的切换(S20)。通过编码器将伺服电机的转速信号转化为脉冲信号输入到伺服驱动器，从而提高速度/位置模式的切换效率，做到让这两种工作模式相互兼容，灵活转换。

Description

送餐机器人速度和位置的双工作模式切换方法及装置 技术领域
本发明涉及伺服电机控制技术领域，具体涉及一种送餐机器人速度和位置的双工作模式切换方法及装置。
背景技术
送餐机器人具有节省人力、增加科技感等优点，因此，送餐机器人在现代餐厅应用的越来越广泛。
送餐机器人的整个行走结构依靠搭载了伺服系统的伺服电机去实现，由于整个伺服控制系统的运动控制部分包含在伺服驱动器里面，所以可以选择灵活的控制方式。但是传统的伺服控制采用的是单一的控制模式，控制模式从速度环切换到位置环可能会重新初始化参数，造成电机停转，导致切换难度加大。
因此，如何使送餐机器人的控制模式能够灵活地从速度环切换到位置环，成为目前亟待解决的问题。
发明内容
有鉴于此，本发明实施例提供了一种送餐机器人速度和位置的双工作模式切换方法及装置，以解决现有技术中送餐机器人采用单一控制模式，在从速度环切换到位置环时可能造成电机停转，导致送餐机器人工作模式切换不灵活的问题。
本发明实施例提供了一种送餐机器人速度和位置的双工作模式切换方法，包括：
获取送餐机器人的运行轨迹信号，以确认送餐机器人在预设运行轨迹上；
当送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制 送餐机器人的伺服电机输出的转速信号通过编码器转换为脉冲信号，再将脉冲信号输入到伺服驱动器，以控制伺服电机，实现速度模式到位置模式的切换。
可选地，还包括：
当送餐机器人与最接近的目标物体之间的距离到达预设值时，获取送餐机器人的当前行进速度；
根据行进速度以及送餐机器人与最接近的目标物体之间的距离，获取编码器需要输出的脉冲总数。
可选地，编码器采用A/B信号格式。
可选地，还包括：
通过四倍频计算编码器的脉冲频率：
Figure PCTCN2022122970-appb-000001
其中，f代表脉冲频率；C代表编码器的线数；n代表电机转速；
计算电机旋转的圈数：
Figure PCTCN2022122970-appb-000002
其中，M 0代表圈数；L代表送餐机器人与最接近的目标物体之间的距离；r代表电机的半径；
计算编码器需要输出的脉冲总数：
Z＝4CM 0
其中，Z代表脉冲总数。
可选地，还包括：编码器输出的脉冲信号变化规律为由密集到稀疏。
可选地，在实现速度模式到位置模式的切换之后，还包括：
根据送餐机器人的实时行进速度以及送餐机器人与最接近的目标物体之间的实时距离，对编码器输出的脉冲信号进行实时调整。
本发明实施例还提供了一种送餐机器人速度和位置的双工作模式切换装置，应用前述送餐机器人速度和位置的双工作模式切换方法，包括：
循迹系统，与运动控制器连接，循迹系统用于获取送餐机器人的运行轨迹信号；循迹系统还用于将运行轨迹信号与预设运行轨迹相比较；
视觉系统，与运动控制器连接，视觉系统用于判断送餐机器人遇到的障碍是否为目标物体；
雷达系统，与运动控制器连接，雷达系统用于获取送餐机器人的位置信息以及送餐机器人与目标物体之间的距离；
运动控制器包括伺服电机、伺服驱动器和编码器；运动控制器用于执行速度模式和位置模式的切换；其中，速度模式和位置模式的切换包括：当送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制送餐机器人的伺服电机输出的转速信号通过编码器转换为脉冲信号，再将脉冲信号输入到伺服驱动器，以控制伺服电机，实现速度模式到位置模式的切换。
可选地，还包括：第一电压比较器和第二电压比较器，分别安装在编码器的输出端；第一电压比较器和第二电压比较器输出A/B的方波信号。
本发明实施例的有益效果：
1、本发明实施例提供了一种送餐机器人速度和位置的双工作模式切换方法，通过编码器将伺服电机的转速信号转化为脉冲信号输入到伺服驱动器，从而提高速度/位置模式的切换效率，做到让这两种工作模式相互兼容，灵活转换。
2、本发明实施例提供的一种送餐机器人速度和位置的双工作模式切换方法，利用多个控制系统对机器人进行精确控制，确保机器人能够按照设定的路径安全准时到达目标物体。
附图说明
通过参考附图会更加清楚的理解本发明的特征和优点，附图是示意性的而不应理解为对本发明进行任何限制，在附图中：
图1示出了本发明实施例1中一种送餐机器人速度和位置的双工作模式切换方法的流程图；
图2示出了本发明实施例1中一种送餐机器人速度和位置的双工作模式切换方法的运行示意图；
图3示出了本发明实施例2中一种送餐机器人速度和位置的双工作模式切换装置的结构图；
图4示出了本发明实施例2中一种送餐机器人速度和位置的双工作模式切换装置的运动控制器结构图。
具体实施方式
为使本发明实施例的目的、技术方案和优点更加清楚，下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域技术人员在没有作出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
实施例1
本发明实施例提供了一种送餐机器人速度和位置的双工作模式切换方法，如图1和图2所示，包括：
步骤S10，获取送餐机器人的运行轨迹信号，以确认送餐机器人在预设运行轨迹上。
在本实施例中，首先对送餐机器人的运行轨迹进行确认，保证送餐机器人处于正确的运行轨迹上。
步骤S20，当送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制送餐机器人的伺服电机输出的转速信号通过编码器转换为脉冲信号，再将脉冲信号输入到伺服驱动器，以控制伺服电机，实现速度模式到位置模式的切换。
在本实施例中，由于在伺服控制系统下，速度模式与位置模式的切换会造成电机停机的问题，因此本实施例将电机转速信号通过编码器转换为脉冲信号输入到伺服驱动器，实现由速度模式到位置模式的切换，提高了速度/位置模式的切换效率，做到让这两种工作模式相互兼容，灵活转换。
作为可选的实施方式，还包括：
当送餐机器人与最接近的目标物体之间的距离到达预设值时，获取送餐机器人的当前行进速度；
根据行进速度以及送餐机器人与最接近的目标物体之间的距离，获取编码器需要输出的脉冲总数。
在本实施例中，将送餐机器人与最接近的目标物体之间的距离作为模式切换的判断条件，如图2所示，当送餐机器人与目标物体之间的距离到达预设值时，执行速度模式到位置模式的切换。
作为可选的实施方式，编码器采用A/B信号格式。
作为可选的实施方式，还包括：
通过四倍频计算编码器的脉冲频率：
Figure PCTCN2022122970-appb-000003
其中，f代表脉冲频率；C代表编码器的线数；n代表电机转速；
计算电机旋转的圈数：
Figure PCTCN2022122970-appb-000004
其中，M 0代表圈数；L代表送餐机器人与最接近的目标物体之间的距离；r代表电机的半径；
计算编码器需要输出的脉冲总数：
Z＝4CM 0
其中，Z代表脉冲总数。
在本实施例中，以编码器的线数C＝1024、电机的转速大小n＝128转/分钟、机器人在进行模式切换时雷达系统检测机器人与目标物体的距离L＝50m为例，计算脉冲频率：
Figure PCTCN2022122970-appb-000005
电机的半径大小r＝0.05m，则可求得电机旋转的圈数：
Figure PCTCN2022122970-appb-000006
最后得到编码器总共输出的脉冲数：
Z＝4×1024×159.155＝651898.88
编码器向伺服驱动器输入一个脉冲，伺服电机步进一段距离，当最后一个脉冲输入完之后，电机处于停机状态，即机器人到达目标物体并停止行进。
作为可选的实施方式，还包括：编码器输出的脉冲信号变化规律为由密集到稀疏。
在本实施例中，在机器人从速度模式切换为位置模式后，将电机速度变化设置为匀速下降，那么相应的脉冲信号变化是一个由密集到稀疏的过程，从而实现机器人工作模式由速度模式到位置模式的平稳切换。
作为可选的实施方式，在实现速度模式到位置模式的切换之后，还包括：
根据送餐机器人的实时行进速度以及送餐机器人与最接近的目标物体之间的实时距离，对编码器输出的脉冲信号进行实时调整。
在本实施例中，对送餐机器人的行进速度与实时位置进行监控并调整脉冲输出，避免出现送餐机器人因为其他原因导致的未在预定位置停止或者撞上目标物体的情况。
本发明实施例提供的一种送餐机器人速度和位置的双工作模式切换方法，利用多个控制系统对机器人进行精确控制，确保机器人能够按照设定的路径安全准时到达目标物体。
实施例2
本发明实施例提供了一种送餐机器人速度和位置的双工作模式切换装置，应用实施例1中的送餐机器人速度和位置的双工作模式切换方法，如图3和图4所示，包括：循迹系统1、运动控制器2、视觉系统3和雷达系统4，其中：循迹系统1与运动控制器2连接，循迹系统1用于获取送餐机器人的运行轨迹信号；循迹系统1还用于将运行轨迹信号与预设运行轨迹 相比较；视觉系统3与运动控制器2连接，视觉系统3用于判断送餐机器人遇到的障碍是否为目标物体；雷达系统4与运动控制器2连接，雷达系统4用于获取送餐机器人的位置信息以及送餐机器人与目标物体之间的距离；运动控制器2包括伺服电机201、伺服驱动器202和编码器203；运动控制器2用于执行速度模式和位置模式的切换；其中，速度模式和位置模式的切换包括：当送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制送餐机器人的伺服电机输出的转速信号通过编码器转换为脉冲信号，再将脉冲信号输入到伺服驱动器，以控制伺服电机，实现速度模式到位置模式的切换。
在本实施例中，伺服驱动器与伺服电机相连，用于控制伺服电机的工作模式；伺服电机与编码器相连，用于在模式切换时将伺服电机的转速信号转化为脉冲信号；编码器与伺服驱动器相连，用于将编码器输出的脉冲信号输入到伺服驱动器，从而实现速度、位置工作模式的切换。由于在伺服控制系统下，速度模式与位置模式的切换会造成电机停机的问题，因此本实施例将电机转速信号通过编码器转换为脉冲信号输入到伺服驱动器，实现由速度模式到位置模式的切换，提高了速度/位置模式的切换效率，做到让这两种工作模式相互兼容，灵活转换。
本发明实施例提供的一种送餐机器人速度和位置的双工作模式切换方法，利用多个控制系统对机器人进行精确控制，确保机器人能够按照设定的路径安全准时到达目标物体。
作为可选的实施方式，还包括：第一电压比较器和第二电压比较器，分别安装在编码器的输出端；第一电压比较器和第二电压比较器输出A/B的方波信号。
在本实施例中，通过两个电压比较器实现编码器的A/B方波信号输出。
由上所述，本发明实施例提供了一种送餐机器人速度和位置的双工作模式切换方法，通过编码器将伺服电机的转速信号转化为脉冲信号输入到伺服驱动器，从而提高速度/位置模式的切换效率，做到让这两种工作模式相互兼容，灵活转换。同时，本发明实施例提供的一种送餐机器人速度和 位置的双工作模式切换方法，利用多个控制系统对机器人进行精确控制，确保机器人能够按照设定的路径安全准时到达目标物体。
虽然结合附图描述了本发明的实施例，但是本领域技术人员可以在不脱离本发明的精神和范围的情况下作出各种修改和变型，这样的修改和变型均落入由所附权利要求所限定的范围之内。

Claims (8)

  1. 一种送餐机器人速度和位置的双工作模式切换方法，其特征在于，包括：
    获取送餐机器人的运行轨迹信号，以确认所述送餐机器人在预设运行轨迹上；
    当所述送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制所述送餐机器人的伺服电机输出的转速信号通过编码器转换为脉冲信号，再将所述脉冲信号输入到伺服驱动器，以控制所述伺服电机，实现速度模式到位置模式的切换。
  2. 根据权利要求1所述的送餐机器人速度和位置的双工作模式切换方法，其特征在于，还包括：
    当所述送餐机器人与最接近的目标物体之间的距离到达预设值时，获取所述送餐机器人的当前行进速度；
    根据所述行进速度以及所述送餐机器人与最接近的所述目标物体之间的距离，获取所述编码器需要输出的脉冲总数。
  3. 根据权利要求2所述的送餐机器人速度和位置的双工作模式切换方法，其特征在于，所述编码器采用A/B信号格式。
  4. 根据权利要求3所述的送餐机器人速度和位置的双工作模式切换方法，其特征在于，还包括：
    通过四倍频计算所述编码器的脉冲频率：
    Figure PCTCN2022122970-appb-100001
    其中，f代表所述脉冲频率；C代表所述编码器的线数；n代表电机转速；
    计算所述电机旋转的圈数：
    Figure PCTCN2022122970-appb-100002
    其中，M 0代表圈数；L代表所述送餐机器人与最接近的所述目标物体 之间的距离；r代表所述电机的半径；
    计算所述编码器需要输出的脉冲总数：
    Z＝4CM 0
    其中，Z代表所述脉冲总数。
  5. 根据权利要求4所述的送餐机器人速度和位置的双工作模式切换方法，其特征在于，还包括：所述编码器输出的脉冲信号变化规律为由密集到稀疏。
  6. 根据权利要求2所述的送餐机器人速度和位置的双工作模式切换方法，其特征在于，在实现速度模式到位置模式的切换之后，还包括：
    根据所述送餐机器人的实时行进速度以及所述送餐机器人与最接近的所述目标物体之间的实时距离，对所述编码器输出的脉冲信号进行实时调整。
  7. 一种送餐机器人速度和位置的双工作模式切换装置，应用如权利要求1～6任一所述送餐机器人速度和位置的双工作模式切换方法，其特征在于，包括：
    循迹系统，与运动控制器连接，所述循迹系统用于获取送餐机器人的运行轨迹信号；所述循迹系统还用于将所述运行轨迹信号与预设运行轨迹相比较；
    视觉系统，与所述运动控制器连接，所述视觉系统用于判断所述送餐机器人遇到的障碍是否为目标物体；
    雷达系统，与所述运动控制器连接，所述雷达系统用于获取所述送餐机器人的位置信息以及所述送餐机器人与所述目标物体之间的距离；
    所述运动控制器包括伺服电机、伺服驱动器和编码器；所述运动控制器用于执行速度模式和位置模式的切换；其中，速度模式和位置模式的切换包括：当所述送餐机器人与最接近的目标物体之间的距离到达预设值时，将控制所述送餐机器人的所述伺服电机输出的转速信号通过所述编码器转换为脉冲信号，再将所述脉冲信号输入到所述伺服驱动器，以控制所述伺服电机，实现速度模式到位置模式的切换。
  8. 根据权利要求7所述的送餐机器人速度和位置的双工作模式切换装置，其特征在于，还包括：第一电压比较器和第二电压比较器，分别安装在所述编码器的输出端；所述第一电压比较器和所述第二电压比较器输出A/B的方波信号。
PCT/CN2022/122970 2022-09-14 2022-09-30 送餐机器人速度和位置的双工作模式切换方法及装置 WO2024055369A1 (zh)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202211115215.9 2022-09-14
CN202211115215.9A CN115431269A (zh) 2022-09-14 2022-09-14 送餐机器人速度和位置的双工作模式切换方法及装置

Publications (1)

Publication Number Publication Date
WO2024055369A1 true WO2024055369A1 (zh) 2024-03-21

Family

ID=84247046

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/122970 WO2024055369A1 (zh) 2022-09-14 2022-09-30 送餐机器人速度和位置的双工作模式切换方法及装置

Country Status (2)

Country Link
CN (1) CN115431269A (zh)
WO (1) WO2024055369A1 (zh)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6393013A (ja) * 1986-10-07 1988-04-23 Sony Corp 位置制御サ−ボ装置
US5083072A (en) * 1988-12-30 1992-01-21 Samsung Electronics Co. Ltd. Position control means and method for servo motor
CN105563485A (zh) * 2015-12-21 2016-05-11 上海师大资产经营有限责任公司 一种送餐机器人控制系统及其运动轨迹控制方法
CN106569494A (zh) * 2016-11-08 2017-04-19 广州大学 基于多传感器融合的送餐机器人控制系统
CN112363445A (zh) * 2020-10-30 2021-02-12 北京精密机电控制设备研究所 一种玻捻机控制系统

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPS6393013A (ja) * 1986-10-07 1988-04-23 Sony Corp 位置制御サ−ボ装置
US5083072A (en) * 1988-12-30 1992-01-21 Samsung Electronics Co. Ltd. Position control means and method for servo motor
CN105563485A (zh) * 2015-12-21 2016-05-11 上海师大资产经营有限责任公司 一种送餐机器人控制系统及其运动轨迹控制方法
CN106569494A (zh) * 2016-11-08 2017-04-19 广州大学 基于多传感器融合的送餐机器人控制系统
CN112363445A (zh) * 2020-10-30 2021-02-12 北京精密机电控制设备研究所 一种玻捻机控制系统

Also Published As

Publication number Publication date
CN115431269A (zh) 2022-12-06

Similar Documents

Publication Publication Date Title
CN101860732B (zh) 一种控制云台摄像机自动跟踪目标的方法
EP0055915A2 (en) Arm locus control method and apparatus
CN103076752B (zh) 舵机控制器、舵机控制方法以及控制系统
CN106200643A (zh) 无反射板激光自主导航agv小车
CN111580453B (zh) 基于plc的提高二维圆弧插补轨迹精度的实现方法
CN1205518C (zh) 同步电动机的无传感器控制装置
CN110422762B (zh) 一种利用行车抓渣的抓斗防摇控制方法
WO2019024570A1 (zh) 一种数字舵机及其控制方法
CN103762522A (zh) 一种高压线路巡检机器人的找线装置及自主找线控制方法
WO2024055369A1 (zh) 送餐机器人速度和位置的双工作模式切换方法及装置
CN108873949A (zh) 一种数字化云台控制方法
CN108237535A (zh) 一种机械臂及其控制系统与方法
KR101869665B1 (ko) 공조기 및 실외 팬 작동 제어 방법 및 시스템
WO2018121505A1 (zh) 用于道岔系统的信号冗余控制系统和方法、以及计算机可读存储介质
CN113021344A (zh) 一种主从异构型遥操作机器人工作空间映射方法
CN207719991U (zh) 一种机器人关节电机伺服控制装置
JPH10117496A (ja) 自動追従装置
JP2021508245A (ja) ハッチ検出方法、システム、移動プラットフォーム及び植物保護無人機
JPH06236206A (ja) 回転テーブルに搭載された産業用ロボットの制御方法
CN107621830B (zh) 一种舞台机械臂的控制方法
KR870000142B1 (ko) 로보트제어 장치에 있어서 축의 원점복귀 방법
CN117260732A (zh) 一种机器人控制系统、方法和机器人
CN116382361A (zh) 一种加速度连续的实时位置规划控制方法
JPH0256681B2 (zh)
CN112389538A (zh) 一种映射对应方式转向控制系统及方法

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 22958559

Country of ref document: EP

Kind code of ref document: A1