RU2454314C2 - Transportation robot having on-board location system (versions) - Google Patents
Transportation robot having on-board location system (versions) Download PDFInfo
- Publication number
- RU2454314C2 RU2454314C2 RU2010116011/02A RU2010116011A RU2454314C2 RU 2454314 C2 RU2454314 C2 RU 2454314C2 RU 2010116011/02 A RU2010116011/02 A RU 2010116011/02A RU 2010116011 A RU2010116011 A RU 2010116011A RU 2454314 C2 RU2454314 C2 RU 2454314C2
- Authority
- RU
- Russia
- Prior art keywords
- wheels
- wheel
- platform
- shafts
- transceivers
- Prior art date
Links
Images
Landscapes
- Manipulator (AREA)
Abstract
Description
Изобретение относится к робототехнике и может найти применение в качестве мобильного робота и самодвижущейся транспортной тележки.The invention relates to robotics and may find application as a mobile robot and a self-propelled transport trolley.
Известен транспортный робот, содержащий платформу со смонтированными на ней колесами, датчиками параметров движения и бортовой компьютер (патент RU №2303240, 2006 г.).Known transport robot containing a platform with wheels mounted on it, motion parameters sensors and an on-board computer (patent RU No. 2303240, 2006).
Данный робот обладает ограниченной маневренностью.This robot has limited maneuverability.
Наиболее близким к предлагаемому изобретению является транспортный робот, содержащий бортовую локационную систему для перемещения в среде с навигационными маркерными элементами, платформу, первое, второе и третье колеса, первый, второй и третий вал, со смонтированными на соответствующих валах первым, вторым и третьим колесами, установленные на платформе вилки первого, второго и третьего колеса со смонтированными в них с возможностью вращения относительно горизонтальных осей вилок валами первого, второго и третьего колес соответственно, причем вилка первого колеса установлена с возможностью поворота вокруг вертикальной оси первой вилки, поворотный электродвигатель первого колеса, выходной вал которого кинематически связан с валом вилки первого колеса, и датчик угла поворота первого колеса, установленные на платформе маршевый электродвигатель первого колеса, выходной вал которого кинематически связан с валом первого колеса, датчик скорости вращения первого колеса и источник питания, а также бортовую вычислительную сеть. При этом в качестве навигационных маркерных элементов используют источники электромагнитного поля, размещенные над опорной плоскостью (патент RU №2130618, 1994 г.).Closest to the proposed invention is a transport robot containing an onboard location system for moving in an environment with navigation marker elements, a platform, a first, second and third wheel, a first, second and third shaft, with first, second and third wheels mounted on the respective shafts, forks of the first, second and third wheels mounted on the platform with the shafts of the first, second and third wheels mounted with them with the possibility of rotation relative to the horizontal axes of the forks, respectively oh, and the first wheel forks mounted rotatably around the vertical axis of the first forks, a rotary electric motor of the first wheel, the output shaft of which is kinematically connected with the shaft of the forks of the first wheel, and a rotation angle sensor of the first wheel mounted on the platform, the main electric motor of the first wheel, the output shaft of which kinematically connected with the shaft of the first wheel, the speed sensor of the first wheel and the power source, as well as the onboard computer network. At the same time, as sources of navigational marker elements, electromagnetic field sources located above the reference plane are used (patent RU No. 2130618, 1994).
Конструктивные особенности данного робота не позволяют ему разворачиваться на месте и осуществлять движение в произвольном направлении без предварительной ориентации робота, что ограничивает его маневренность в целом. Кроме того, робот не может определять направление на навигационные маркерные элементы в цехах промышленных предприятий в присутствии сильных электромагнитных полей от работающего оборудования.The design features of this robot do not allow it to turn around in place and carry out movement in an arbitrary direction without preliminary orientation of the robot, which limits its maneuverability as a whole. In addition, the robot cannot determine the direction of the navigation marker elements in the workshops of industrial enterprises in the presence of strong electromagnetic fields from operating equipment.
Техническим результатом, на достижение которого направлено данное изобретение по первому варианту, является повышение маневренности транспортного робота и расширение функциональных возможностей робота за счет обеспечения возможности определять направление и осуществлять движение на навигационные маркерные элементы в цехах промышленных предприятий в присутствии сильных электромагнитных полей от работающего оборудования.The technical result to which this invention is directed according to the first embodiment is to increase the maneuverability of the transport robot and expand the functionality of the robot by providing the ability to determine the direction and move to navigation marker elements in the shops of industrial enterprises in the presence of strong electromagnetic fields from operating equipment.
Техническим результатом, на достижение которого направлено данное изобретение по второму варианту, является повышение маневренности транспортного робота и расширение функциональных возможностей робота за счет обеспечения возможности определять свое положение относительно навигационных маркерных элементов в цехах промышленных предприятий в присутствии сильных электромагнитных полей от работающего оборудования и осуществлять движение по светоконтрастной полосе на полу в цехах промышленных предприятий в присутствии сильных электромагнитных полей от работающего оборудования.The technical result to which this invention is directed according to the second embodiment is to increase the maneuverability of the transport robot and expand the functionality of the robot by providing the ability to determine its position relative to navigation marker elements in the shops of industrial enterprises in the presence of strong electromagnetic fields from operating equipment and to carry out a light-contrast strip on the floor in the workshops of industrial enterprises in the presence of strong elec ferromagnetic fields of working environment.
Указанный технический результат по первому варианту достигается тем, что в транспортный робот, содержащий бортовую локационную систему для перемещения в среде с навигационными маркерными элементами, платформу, первое, второе и третье колеса, первый, второй и третий вал, со смонтированными на соответствующих валах первым, вторым и третьим колесами, установленные на платформе вилки первого, второго и третьего колеса со смонтированными в них с возможностью вращения относительно горизонтальных осей вилок валами первого, второго и третьего колес соответственно, причем вилка первого колеса установлена с возможностью поворота вокруг вертикальной оси первой вилки, поворотный электродвигатель первого колеса, выходной вал которого кинематически связан с валом вилки первого колеса, и датчик угла поворота первого колеса, установленные на платформе маршевый электродвигатель первого колеса, выходной вал которого кинематически связан с валом первого колеса, датчик скорости вращения первого колеса и источник питания, а также бортовую вычислительную сеть, дополнительно введены поворотные электродвигатели второго и третьего колеса, маршевые электродвигатели второго и третьего колеса, датчики угла поворота второго и третьего колеса, датчики скорости вращения второго и третьего колеса и беспроводной канал обмена данными, при этом вилка второго колеса и вилка третьего колеса установлены на платформе с возможностью поворота вокруг вертикальной оси соответствующей вилки на произвольный угол и, кроме того, вилка первого колеса, вилка второго колеса и вилка третьего колеса установлены на платформе с возможностью передачи питающего напряжения от источника питания на вал соответствующей вилки, при этом проекции точек пересечения вертикальных осей валов вилок и горизонтальных осей валов соответствующих колес на горизонтальную плоскость расположены в вершинах равностороннего треугольника, при этом поворотные электродвигатели второго и третьего колес и датчики угла поворота второго и третьего колес установлены на платформе, а выходные валы поворотных электродвигателей второго и третьего колес кинематически связаны с валами вилок второго и третьего колес соответственно, при этом маршевые электродвигатели первого, второго и третьего колеса и датчики скорости вращения первого, второго и третьего колес кинематически связаны с валами первого, второго и третьего колес соответственно, бортовая вычислительная сеть выполнена распределенной и с возможностью сбора и обработки данных с датчиков угла поворота, датчиков скорости вращения первого, второго и третьего колеса и бортовой локационной системы и формирования и передачи управляющих сигналов на поворотные и маршевые электродвигатели первого, второго и третьего колеса, при этом первая часть элементов бортовой вычислительной сети установлена на платформе, а оставшаяся вторая часть - на вилках колес, при этом первая и вторая части элементов бортовой вычислительной сети соединены беспроводным каналом обмена данными, при этом в качестве навигационных маркерных элементов используют светоизлучающие маяки, установленные на опорной плоскости, а бортовая локационная система выполнена с возможностью определения направлений на светоизлучающие маяки.The specified technical result according to the first embodiment is achieved in that in a transport robot containing an onboard location system for moving in an environment with navigation marker elements, a platform, first, second and third wheels, a first, second and third shaft, with the first mounted on the respective shafts, the second and third wheels mounted on the platform of the forks of the first, second and third wheels with mounted in them with the possibility of rotation relative to the horizontal axes of the forks by the shafts of the first, second and third wheels, respectively, with the first wheel forks mounted pivotally around the vertical axis of the first forks, a rotary electric motor of the first wheel, the output shaft of which is kinematically connected with the shaft of the forks of the first wheel, and a rotation angle sensor of the first wheel mounted on the platform the main electric motor of the first wheel, the output shaft which is kinematically connected with the shaft of the first wheel, the speed sensor of the first wheel and the power source, as well as the on-board computer network, are additionally introduced gate electric motors of the second and third wheels, marching electric motors of the second and third wheels, angle sensors of rotation of the second and third wheels, speed sensors of rotation of the second and third wheels and a wireless data exchange channel, while the fork of the second wheel and the fork of the third wheel are mounted on the platform with the possibility of rotation around the vertical axis of the corresponding fork at an arbitrary angle and, in addition, the fork of the first wheel, the fork of the second wheel and the fork of the third wheel are mounted on the platform with the possibility of voltage supply from the power source to the shaft of the corresponding fork, while the projections of the intersection points of the vertical axes of the forks and the horizontal axes of the shafts of the corresponding wheels on a horizontal plane are located at the vertices of an equilateral triangle, while the rotary motors of the second and third wheels and the angle sensors of the second and third wheels are mounted on the platform, and the output shafts of the rotary motors of the second and third wheels are kinematically connected with the forks of the forks of the second and third about the wheels, respectively, while the main electric motors of the first, second and third wheels and the speed sensors of the first, second and third wheels are kinematically connected with the shafts of the first, second and third wheels, respectively, the on-board computer network is distributed and can collect and process data from sensors rotation angle, rotation speed sensors of the first, second and third wheels and onboard location system and the formation and transmission of control signals to rotary and marching electric motors whether the first, second and third wheels, while the first part of the components of the on-board computer network is mounted on the platform, and the remaining second part is mounted on the forks of the wheels, while the first and second parts of the components of the on-board computer network are connected by a wireless data exchange channel, while as navigation marker elements use light emitting beacons mounted on a reference plane, and the airborne location system is configured to determine directions to light emitting beacons.
Кроме того, беспроводной канал обмена данными содержит первую, вторую и третью пары приемопередатчиков, при этом первые приемопередатчики первой, второй и третьей пар приемопередатчиков смонтированы на платформе, а вторые приемопередатчики из первой, второй и третьей пар приемопередатчиков смонтированы на валах вилок первого, второго и третьего колес соответственно, с возможностью взаимодействия с первыми приемопередатчиками соответствующей пары приемопередатчиков.In addition, the wireless communication channel contains the first, second and third pairs of transceivers, while the first transceivers of the first, second and third pairs of transceivers are mounted on the platform, and the second transceivers of the first, second and third pairs of transceivers are mounted on the shafts of the forks of the first, second and third wheels, respectively, with the possibility of interaction with the first transceivers of the corresponding pair of transceivers.
Кроме того, первая часть элементов бортовой вычислительной сети содержит головной контроллер, контроллеры управления поворотными электродвигателями первого, второго и третьего колес и первый контроллер бортовой локационной системы, а вторая часть элементов бортовой вычислительной сети содержит контроллеры управления маршевыми электродвигателями первого, второго и третьего колес.In addition, the first part of the components of the onboard computer network contains a head controller, controllers for controlling the rotary motors of the first, second and third wheels and the first controller of the onboard location system, and the second part of the elements of the onboard computer network contains controllers for controlling the main engines of the first, second and third wheels.
Кроме того, выходные валы второго и третьего маршевых электродвигателей кинематически связаны с валами второго и третьего колес соответственно, управляющие входы первого, второго и третьего маршевых электродвигателей подключены к управляющим выходам контроллеров, подключенных также к датчикам скорости вращения первого, второго и третьего колеса соответственно, а управляющие входы первого, второго и третьего поворотных электродвигателей подключены к управляющим выходам контроллеров, подключенных также к датчикам угла поворота первого, второго и третьего колеса соответственно.In addition, the output shafts of the second and third main electric motors are kinematically connected with the shafts of the second and third wheels, respectively, the control inputs of the first, second and third main electric motors are connected to the control outputs of the controllers, also connected to the speed sensors of the first, second and third wheels, respectively, and the control inputs of the first, second and third rotary electric motors are connected to the control outputs of the controllers, also connected to the angle sensors of the first first, second and third wheels, respectively.
Кроме того, в качестве приемопередатчиков использованы приемопередатчики инфракрасного излучения.In addition, infrared transceivers are used as transceivers.
Кроме того, установленные на платформе с возможностью передачи питающего напряжения от источника питания на вал вилки, вилки каждого из колес оснащены соответствующими узлами передачи электрического сигнала через вращающееся сочленение, при этом каждый узел передачи электрического сигнала через вращающееся сочленение содержит смонтированный на платформе подшипник с установленным в нем валом вилки, опору и токоподводящие щетки, установленные на соответствующем валу с возможностью электрического контакта с соответствующей опорой, электрически соединенной с источником питания.In addition, mounted on the platform with the possibility of transmitting the supply voltage from the power source to the fork shaft, the forks of each of the wheels are equipped with corresponding nodes for transmitting the electric signal through the rotating joint, while each node for transmitting the electric signal through the rotating joint contains a bearing mounted on the platform with a fork shaft, a support and current-carrying brushes mounted on the corresponding shaft with the possibility of electrical contact with the corresponding support, e ektricheski connected to a power source.
Кроме того, он содержит площадку и стойки, посредством которых площадка смонтирована на платформе параллельно ей, а бортовая локационная система содержит установленные на площадке светоотражающий конус и фотообъектив с установленной в фокусной плоскости фотообъектива фотоприемной матрицей, а вход первого контроллера бортовой локационной системы подключен к выходу фотоприемной матрицы.In addition, it contains a platform and racks through which the platform is mounted parallel to it, and the on-board location system contains a reflective cone and a photo lens mounted on the site with a photodetector installed in the focal plane of the photo lens, and the input of the first controller of the on-board location system is connected to the photodetector output matrices.
Кроме того, выход фотоприемной матрицы подключен ко входу первого контроллера бортовой локационной системы.In addition, the output of the photodetector is connected to the input of the first controller of the on-board location system.
Кроме того, ось вращения светоотражающего конуса совпадает с оптической осью фотообъектива и проходит через центр фотоприемной матрицы и центр платформы, а одна из осей фотоприемной матрицы располагается параллельно горизонтальной оси, проходящей из центра платформы через ось вала вилки первого колеса.In addition, the axis of rotation of the reflective cone coincides with the optical axis of the photo lens and passes through the center of the photodetector and the center of the platform, and one of the axes of the photodetector is parallel to the horizontal axis passing from the center of the platform through the axis of the forks of the first wheel.
Кроме того, угол раскрыва светоотражающего конуса выбран равным 90°.In addition, the opening angle of the reflective cone is selected equal to 90 °.
Указанный технический результат по второму варианту достигается тем, что в транспортный робот, содержащий бортовую локационную систему для перемещения в среде с навигационными маркерными элементами, включающий платформу, первое, второе и третье колеса, первый, второй и третий вал, со смонтированными на соответствующих валах первым, вторым и третьим колесами, установленные на платформе вилки первого, второго и третьего колеса со смонтированными в них с возможностью вращения относительно горизонтальных осей вилок валами первого, второго и третьего колес соответственно, причем вилка первого колеса установлена с возможностью поворота вокруг вертикальной оси первой вилки, поворотный электродвигатель первого колеса, выходной вал которого кинематически связан с валом вилки первого колеса, и датчик угла поворота первого колеса, установленные на платформе маршевый электродвигатель первого колеса, выходной вал которого кинематически связан с валом первого колеса, датчик скорости вращения первого колеса и источник питания, а также бортовую вычислительную сеть, дополнительно введены поворотные электродвигатели второго и третьего колеса, маршевые электродвигатели второго и третьего колеса, датчики угла поворота второго и третьего колеса, датчики скорости вращения второго и третьего колеса и беспроводной канал обмена данными, при этом вилка второго колеса и вилка третьего колеса установлены на платформе с возможностью поворота вокруг вертикальной оси соответствующей вилки на произвольный угол и, кроме того, вилка первого колеса, вилка второго колеса и вилка третьего колеса установлены на платформе с возможностью передачи питающего напряжения от источника питания на вал соответствующей вилки, при этом проекции точек пересечения вертикальных осей валов вилок и горизонтальных осей валов соответствующих колес на горизонтальную плоскость расположены в вершинах равностороннего треугольника, при этом поворотные электродвигатели второго и третьего колес и датчики угла поворота второго и третьего колес установлены на платформе, а выходные валы поворотных электродвигателей второго и третьего колес кинематически связаны с валами вилок второго и третьего колес соответственно, при этом маршевые электродвигатели первого, второго и третьего колеса и датчики скорости вращения первого, второго и третьего колес кинематически связаны с валами первого, второго и третьего колес соответственно, бортовая вычислительная сеть выполнена распределенной и с возможностью сбора и обработки данных с датчиков угла поворота, датчиков скорости вращения первого, второго и третьего колеса бортовой локационной системы и формирования и передачи управляющих сигналов на поворотные и маршевые электродвигатели первого, второго и третьего колеса, при этом первая часть элементов бортовой вычислительной сети установлена на платформе, а оставшаяся вторая часть - на вилках колес, при этом первая и вторая части элементов бортовой вычислительной сети соединены беспроводным каналом обмена данными, при этом в качестве навигационных маркерных элементов используют светоконтрастную полосу, нанесенную на опорной плоскости, а бортовая локационная система выполнена с возможностью определения величины отклонения точки касания первым колесом робота опорной плоскости от средней линии светоконтрастной полосы и угла отклонения проекции продольной оси первого колеса робота на опорную плоскость от касательной к средней линии светоконтрастной полосы.The specified technical result according to the second embodiment is achieved by the fact that in a transport robot containing an onboard location system for moving in an environment with navigation marker elements, including a platform, first, second and third wheels, a first, second and third shaft, with the first mounted on the respective shafts , the second and third wheels mounted on the platform of the forks of the first, second and third wheels with mounted in them with the possibility of rotation relative to the horizontal axis of the forks by the shafts of the first, second and third wheels, respectively, wherein the first wheel forks are mounted rotatably about the vertical axis of the first forks, a rotary electric motor of the first wheel, the output shaft of which is kinematically connected to the shaft of the forks of the first wheel, and a rotation angle sensor of the first wheel mounted on the platform the main electric motor of the first wheel, the output shaft of which is kinematically connected with the shaft of the first wheel, the speed sensor of the first wheel and the power source, as well as the on-board computer network, about introduced rotary electric motors of the second and third wheels, marching electric motors of the second and third wheels, angle sensors of rotation of the second and third wheels, speed sensors of rotation of the second and third wheels and a wireless data exchange channel, while the fork of the second wheel and the fork of the third wheel are mounted on a platform with the ability to rotate around the vertical axis of the corresponding fork at an arbitrary angle and, in addition, the fork of the first wheel, the fork of the second wheel and the fork of the third wheel are mounted on a platform with the transmission voltage from the power source to the shaft of the corresponding fork, while the projections of the intersection points of the vertical axes of the forks and the horizontal axes of the shafts of the corresponding wheels on a horizontal plane are located at the vertices of an equilateral triangle, while the rotary motors of the second and third wheels and the angle sensors of the second and the third wheels are mounted on the platform, and the output shafts of the rotary motors of the second and third wheels are kinematically connected with the forks of the forks of the second th and third wheels, respectively, while the marching electric motors of the first, second and third wheels and the rotational speed sensors of the first, second and third wheels are kinematically connected with the shafts of the first, second and third wheels, respectively, the on-board computer network is distributed and with the ability to collect and process data from rotation angle sensors, rotation speed sensors of the first, second and third wheels of the onboard location system and the formation and transmission of control signals to rotary and marching electric the first, second and third wheels, the first part of the components of the on-board computer network is installed on the platform, and the remaining second part is mounted on the forks of the wheels, while the first and second parts of the components of the on-board computer network are connected by a wireless data exchange channel, while as navigation marker elements use a light-contrast strip deposited on the reference plane, and the airborne location system is configured to determine the magnitude of the deviation of the point of contact of the first wheel Obote reference plane of the midline svetokontrastnoy strip projection and the deflection angle to the longitudinal axis of the robot on the first wheel from the reference plane tangent to the center line svetokontrastnoy strip.
Кроме того, беспроводной канал обмена данными может содержать первую, вторую и третью пары приемопередатчиков, при этом первые приемопередатчики первой, второй и третьей пар приемопередатчиков смонтированы на платформе, а вторые приемопередатчики из первой, второй и третьей пар приемопередатчиков смонтированы на валах вилок первого, второго и третьего колес соответственно, с возможностью взаимодействия с первыми приемопередатчиками соответствующей пары приемопередатчиков.In addition, the wireless data exchange channel may contain the first, second and third pairs of transceivers, with the first transceivers of the first, second and third pairs of transceivers mounted on the platform, and the second transceivers of the first, second and third pairs of transceivers mounted on the shafts of the forks of the first, second and third wheels, respectively, with the possibility of interaction with the first transceivers of the corresponding pair of transceivers.
Кроме того, первая часть элементов бортовой вычислительной сети содержит головной контроллер, контроллеры управления поворотными электродвигателями первого, второго и третьего колес и первый контроллер бортовой локационной системы, а вторая часть элементов бортовой вычислительной сети содержит контроллеры управления маршевыми электродвигателями первого, второго и третьего колес.In addition, the first part of the components of the onboard computer network contains a head controller, controllers for controlling the rotary motors of the first, second and third wheels and the first controller of the onboard location system, and the second part of the elements of the onboard computer network contains controllers for controlling the main engines of the first, second and third wheels.
Кроме того, выходные валы второго и третьего маршевых электродвигателей кинематически связаны с валами второго и третьего колес соответственно, управляющие входы первого, второго и третьего маршевых электродвигателей подключены к управляющим выходам контроллеров, подключенных также к датчикам скорости вращения первого, второго и третьего колеса соответственно, а управляющие входы первого, второго и третьего поворотных электродвигателей подключены к управляющим выходам контроллеров, подключенных также к датчикам угла поворота первого, второго и третьего колеса соответственно.In addition, the output shafts of the second and third main electric motors are kinematically connected with the shafts of the second and third wheels, respectively, the control inputs of the first, second and third main electric motors are connected to the control outputs of the controllers, also connected to the speed sensors of the first, second and third wheels, respectively, and the control inputs of the first, second and third rotary electric motors are connected to the control outputs of the controllers, also connected to the angle sensors of the first first, second and third wheels, respectively.
Кроме того, в качестве приемопередатчиков использованы приемопередатчики инфракрасного излучения.In addition, infrared transceivers are used as transceivers.
Кроме того, установленные на платформе с возможностью передачи питающего напряжения от источника питания на вал вилки, вилки каждого из колес оснащены соответствующими узлами передачи электрического сигнала через вращающееся сочленение, при этом каждый узел передачи электрического сигнала через вращающееся сочленение содержит смонтированный на платформе подшипник с установленным в нем валом вилки, опору и токоподводящие щетки, установленные на соответствующем валу с возможностью электрического контакта с соответствующей опорой, электрически соединенной с источником питания.In addition, mounted on the platform with the possibility of transmitting the supply voltage from the power source to the fork shaft, the forks of each of the wheels are equipped with corresponding nodes for transmitting the electric signal through the rotating joint, while each node for transmitting the electric signal through the rotating joint contains a bearing mounted on the platform with a fork shaft, a support and current-carrying brushes mounted on the corresponding shaft with the possibility of electrical contact with the corresponding support, e ektricheski connected to a power source.
Кроме того, в него дополнительно введен кронштейн, жестко закрепленный на валу вилки первого колеса таким образом, что вертикальная плоскость симметрии кронштейна совпадает с расположенной перпендикулярно оси вращения первого колеса вертикальной плоскостью симметрии первого колеса, а бортовая локационная система содержит оптронную линейку, лампу подсветки и второй контроллер бортовой локационной системы, причем оптронная линейка и лампа подсветки смонтированы на кронштейне параллельно опорной плоскости и параллельно оси вращения первого колеса.In addition, an arm is additionally inserted into it, which is rigidly fixed to the shaft of the forks of the first wheel so that the vertical plane of symmetry of the bracket coincides with the vertical plane of symmetry of the first wheel perpendicular to the axis of rotation of the first wheel, and the side location system contains an optical line, a backlight, and a second the controller of the onboard location system, the optical line and the backlight being mounted on the bracket parallel to the reference plane and parallel to the axis of rotation ervogo wheel.
Кроме того, выходы оптронной линейки подключены к соответствующим входам второго контроллера бортовой локационной системы, подключенного к соответствующему входу контроллера управления маршевым электродвигателем первого колеса.In addition, the outputs of the optocoupler line are connected to the corresponding inputs of the second controller of the onboard location system, connected to the corresponding input of the controller for controlling the main electric motor of the first wheel.
На фиг.1 изображен внешний вид транспортного робота с бортовой локационной системой по первому варианту, на фиг.2 - кинематическая схема транспортного робота, на фиг.3 - вид сверху на платформу робота с установленными на ней элементами, на фиг.4 - вид снизу на платформу робота с установленными на ней элементами.Figure 1 shows the appearance of a transport robot with an on-board location system according to the first embodiment, figure 2 is a kinematic diagram of a transport robot, figure 3 is a top view of a robot platform with elements mounted on it, and figure 4 is a bottom view to the robot platform with elements installed on it.
На фиг.5 приведена функциональная схема распределенной бортовой вычислительной сети с подключенными к ней датчиками и электродвигателями для первого варианта, на фиг.6 - фрагмент фиг.3, а на фиг.7 - вариант конструктивного исполнения узла передачи электрического сигнала через вращающееся сочленение.Figure 5 shows a functional diagram of a distributed on-board computer network with sensors and electric motors connected to it for the first embodiment, Fig. 6 is a fragment of Fig. 3, and Fig. 7 is a structural embodiment of an electric signal transmission unit through a rotating joint.
На фиг.8 изображен внешний вид транспортного робота с бортовой локационной системой по второму варианту, а на фиг.9 - функциональная схема распределенной бортовой вычислительной сети с подключенными к ней датчиками и электродвигателями для второго варианта.In Fig.8 shows the appearance of a transport robot with an onboard location system according to the second embodiment, and Fig.9 is a functional diagram of a distributed onboard computer network with connected sensors and electric motors for the second embodiment.
На фиг.10 изображена платформа транспортного робота со схематическим размещением на ней фотоприемной матрицы и размещение самой платформы на опорной плоскости для первого варианта.Figure 10 shows the platform of the transport robot with a schematic placement of a photodetector matrix on it and the placement of the platform itself on the reference plane for the first embodiment.
На фиг.11 изображена платформа 1 транспортного робота со схематическим размещением на ней оптронной линейки 84 и размещение самой платформы 1 на опорной плоскости XOY для второго варианта.Figure 11 shows the
На фиг.1-11 обозначены: 1 - платформа в виде равностороннего треугольника; 2, 3 и 4 - соответственно первое, второе и третье колесо; 5, 6 и 7 - соответственно первый, второй и третий вал; 8, 9 и 10 - вилка первого, второго и третьего колеса соответственно; 11, 12 и 13 - горизонтальные оси вилок первого, второго и третьего колеса; 14 - вертикальная ось вилки первого колеса; 15 - поворотный электродвигатель первого колеса; 16 - выходной вал поворотного электродвигателя первого колеса; 17 - вал вилки первого колеса; 18 - датчик угла поворота первого колеса; 19 - маршевый электродвигатель первого колеса; 20 - выходной вал маршевого электродвигателя первого колеса; 21 - датчик скорости вращения первого колеса; 22 - источник питания; 23 - бортовая вычислительная сеть; 24 и 25 - поворотные электродвигатели второго и третьего колеса соответственно; 26 и 27 - маршевые электродвигатели второго и третьего колеса соответственно; 28 и 29 - датчики угла поворота второго и третьего колеса соответственно; 30 и 31 - датчики скорости вращения второго и третьего колеса соответственно; 32 - беспроводной канал обмена данными; 33 и 34 - вертикальная ось вилки второго и третьего колеса соответственно; 35 и 36 - вал вилки второго и третьего колеса соответственно; 37 и 38 - выходные валы поворотных электродвигателей второго и третьего колеса соответственно; 39 и 40 - первая и соответственно вторая части элементов бортовой вычислительной сети; 41, 42 и 43 - соответственно первая, вторая и третья пара приемопередатчиков; 45, 45 и 46 - первые приемопередатчики первой, второй и третьей пар приемопередатчиков 41, 42 и 43 соответственно; 47, 48 и 49 - вторые приемопередатчики первой, второй и третьей пар приемопередатчиков 41, 42 и 43 соответственно; 50 - головной контроллер; 51, 52 и 53 - контроллеры управления поворотными электродвигателями первого, второго и третьего колеса соответственно; 54, 55 и 56 - контроллеры управления маршевыми электродвигателями первого, второго и третьего колеса соответственно; 57 и 58 - выходные валы второго и третьего маршевых электродвигателей; 59, 60 и 61 - первый, второй и третий узлы передачи электрического сигнала через вращающееся сочленение; 62, 63 и 64 - подшипник вала вилки первого, второго и третьего колеса соответственно; 65, 66 и 67 - опора подшипника вала вилки первого, второго и третьего колеса соответственно; 68 и 69, 70 и 71 и 72 и 73 - первая, вторая и третья пара токоподводящих щеток вала вилки первого, второго и третьего колеса соответственно; 74 - площадка; 75 - светоотражающий конус; 76 - фотообъектив; 77 - фотоприемная матрица; 78 - первый контроллер бортовой локационной системы; 79 - ось вращения светоотражающего конуса; 80 - оптическая ось фотообъектива; 81 - одна из осей фотоприемной матрицы; 82 - горизонтальная ось, проходящая из центра платформы через ось вала вилки первого колеса; 83 - кронштейн; 84 - оптронная линейка; 85 - лампа подсветки; 86 - второй контроллер бортовой локационной системы; 87 - светоизлучающие маяки; 88 - светоконтрастная полоса; 89 - средняя линия светоконтрастной полосы; 90 - горизонтальная продольная ось первого колеса; 91 - стойки; 92 - проекция горизонтальной продольной оси первого колеса на опорную плоскость; 93 - вертикальная ось первого колеса; 94 - проекция на опорную плоскость горизонтальной оси, проходящей из центра платформы через ось вала вилки первого колеса; 95 - ось симметрии верхней плоскости кронштейна.Figure 1-11 marked: 1 - platform in the form of an equilateral triangle; 2, 3 and 4 - respectively the first, second and third wheel; 5, 6 and 7 - respectively, the first, second and third shaft; 8, 9 and 10 - fork of the first, second and third wheels, respectively; 11, 12 and 13 - horizontal axis of the forks of the first, second and third wheels; 14 - the vertical axis of the fork of the first wheel; 15 - rotary electric motor of the first wheel; 16 - the output shaft of the rotary motor of the first wheel; 17 - a shaft of a fork of the first wheel; 18 - the angle sensor of the first wheel; 19 - marching electric motor of the first wheel; 20 - output shaft of the marching electric motor of the first wheel; 21 - a speed sensor of the first wheel; 22 - power source; 23 - on-board computer network; 24 and 25 - rotary motors of the second and third wheels, respectively; 26 and 27 - mid-flight electric motors of the second and third wheels, respectively; 28 and 29 - angle sensors of the second and third wheels, respectively; 30 and 31 - speed sensors of the second and third wheels, respectively; 32 - wireless data exchange channel; 33 and 34 - the vertical axis of the fork of the second and third wheels, respectively; 35 and 36 - fork shaft of the second and third wheels, respectively; 37 and 38 - output shafts of rotary motors of the second and third wheels, respectively; 39 and 40 - the first and respectively second parts of the components of the onboard computer network; 41, 42 and 43 - respectively, the first, second and third pair of transceivers; 45, 45 and 46 - the first transceivers of the first, second and third pairs of transceivers 41, 42 and 43, respectively; 47, 48 and 49 - second transceivers of the first, second and third pairs of transceivers 41, 42 and 43, respectively; 50 - head controller; 51, 52 and 53 - controllers for controlling rotary electric motors of the first, second and third wheels, respectively; 54, 55, and 56 — controllers for controlling the marching electric motors of the first, second, and third wheels, respectively; 57 and 58 - output shafts of the second and third sustainer electric motors; 59, 60 and 61 - the first, second and third nodes of the transmission of an electrical signal through a rotating joint; 62, 63 and 64 - bearing shaft forks of the first, second and third wheels, respectively; 65, 66 and 67 - bearing forkshaft shaft bearings of the first, second and third wheels, respectively; 68 and 69, 70 and 71 and 72 and 73 - the first, second and third pair of current-carrying brushes of the fork shaft of the first, second and third wheels, respectively; 74 - platform; 75 - reflective cone; 76 - photo lens; 77 - photodetector array; 78 - the first controller of the onboard location system; 79 - axis of rotation of the reflective cone; 80 - optical axis of the photo lens; 81 - one of the axes of the photodetector array; 82 - horizontal axis passing from the center of the platform through the axis of the shaft of the fork of the first wheel; 83 - bracket; 84 - an optical line; 85 - backlight; 86 - the second controller of the onboard location system; 87 - light emitting beacons; 88 - light contrast band; 89 - the middle line of the light contrast band; 90 - horizontal longitudinal axis of the first wheel; 91 - racks; 92 is a projection of the horizontal longitudinal axis of the first wheel onto a support plane; 93 - the vertical axis of the first wheel; 94 is a projection onto a reference plane of a horizontal axis passing from the center of the platform through the axis of the forks of the first wheel; 95 - axis of symmetry of the upper plane of the bracket.
Кроме того, на фиг.10-16 обозначены: точка С - центр платформы 1; точки С1, С2 и С3 - точки на платформе 1, через которые проходят оси 14, 33 и 34 валов 17, 35 и 36 вилок 8, 9 и 10 соответственно первого 2, второго 3 и третьего 4 колеса; точка Р - мгновенный центр скоростей платформы, то есть точка, в которой сходятся оси 11, 12 и 13 валов 5, 6 и 7 колес 2, 3 и 4; x1 - проекция горизонтальной продольной оси 90 первого колеса 2 на опорную плоскость XOY; x2 и x3 - горизонтальные продольные оси второго 3 и третьего 4 колес соответственно; C1P, C2P и C3P - прямые линии, на которых лежат оси 11, 12 и 13 валов 5, 6 и 7 первого 2, второго 3 и третьего 4 колес соответственно; x' - проекция 94 на опорную плоскость XOY горизонтальной оси 82, проходящей из центра С платформы 1 через ось 14 вала 17 вилки 8 первого колеса 2 перпендикулярно этой оси 14; βi (i=1, 2, 3) - угол поворота вала 17 (35, 36) вилки 8 (9, 10) первого 2, второго 3 и третьего 4 колеса относительно оси x' (для угла β1 - он же угол между двумя перпендикулярными опорной плоскости XOY плоскостями: плоскостью, проходящей через оси 92, 90 и 95, и плоскостью, проходящей через оси 94 и 82); φi (i=1, 2, 3) - угол поворота вала 5, 6 и 7 соответственно первого 2, второго 3 и третьего 4 колеса.In addition, figure 10-16 indicated: point C is the center of the
Транспортный робот, содержащий бортовую локационную систему для перемещения в среде с навигационными маркерными элементами по первому варианту, включает платформу 1, первое, второе и третье колеса 2, 3 и 4, первый, второй и третий вал 5, 6 и 7, со смонтированными на соответствующих валах 5, 6 и 7 первым, вторым и третьим колесами 2. 3 и 4, установленные на платформе 1 вилки первого, второго и третьего колеса 8, 9 и 10 со смонтированными в них с возможностью вращения относительно горизонтальных осей 11, 12 и 13 вилок 8, 9 и 10 валами 5, 6 и 7 первого, второго и третьего колес 2, 3 и 4 соответственно, причем вилка 8 первого колеса 2 установлена с возможностью поворота вокруг вертикальной оси 14 первой вилки 8, поворотный электродвигатель 15 первого колеса 2, выходной вал 16 которого кинематически связан с валом 17 вилки 8 первого колеса 2, и датчик 18 угла поворота первого колеса 2, установленные на платформе 1 маршевый электродвигатель 19 первого колеса 2, выходной вал 20 которого кинематически связан с валом 5 первого колеса 2, датчик 21 скорости вращения первого колеса 2 и источник питания 22, а также бортовую вычислительную сеть 23.A transport robot containing an onboard location system for moving in an environment with navigation marker elements according to the first embodiment includes a
Кроме того, транспортный робот по первому варианту содержит поворотные электродвигатели 24 и 25 второго и третьего колеса 3 и 4, маршевые электродвигатели 26 и 27 второго и третьего колеса 3 и 4, датчики 28 и 29 угла поворота второго и третьего колеса 3 и 4, датчики 30 и 31 скорости вращения второго и третьего колеса 3 и 4 и беспроводной канал 32 обмена данными, при этом вилка 8 первого колеса 2, вилка 9 второго колеса 3 и вилка 10 третьего колеса 4 установлены на платформе 1 с возможностью поворота вокруг вертикальной оси 14, 33 и 34 на произвольный угол и с возможностью передачи питающего напряжения от источника питания 22 на вал 17, 35 и 36 соответствующей вилки 8, 9 и 10, при этом проекции точек пересечения вертикальных осей 14, 33 и 34 валов 5, 6 и 7 вилок 8, 9 и 10 и горизонтальных осей 11, 12 и 13 валов 5, 6 и 7 соответствующих колес 2, 3 и 4 на горизонтальную плоскость расположены в вершинах равностороннего треугольника, при этом поворотные электродвигатели 24 и 25 второго и третьего колес 3 и 4 и датчики 28 и 29 угла поворота второго и третьего колес 3 и 4 установлены на платформе 1, а выходные валы 37 и 38 поворотных электродвигателей 24 и 25 второго и третьего колес 3 и 4 кинематически связаны с валами 35 и 36 вилок 9 и 10 второго и третьего колес 3 и 4 соответственно, при этом маршевые электродвигатели 19, 26 и 27 первого, второго и третьего колеса 2, 3 и 4 и датчики 21, 30 и 31 скорости вращения первого, второго и третьего колес 2, 3 и 4 кинематически связаны с валами 5, 6 и 7 первого, второго и третьего колес 2, 3 и 4 соответственно, бортовая вычислительная сеть 23 выполнена распределенной и с возможностью сбора и обработки данных с датчиков 18, 28 и 29 угла поворота, датчиков 21, 30 и 31 скорости вращения первого, второго и третьего колеса 2, 3 и 4 и бортовой локационной системы и формирования и передачи управляющих сигналов на поворотные 15, 24 и 25 и маршевые 19, 26 и 27 электродвигатели первого, второго и третьего колеса 2, 3 и 4, при этом первая часть 39 элементов бортовой вычислительной сети 23 установлена на платформе 1, а оставшаяся вторая часть 40 - на вилках 8, 9 и 10 колес 2, 3 и 4, при этом первая и вторая части 39 и 40 элементов бортовой вычислительной сети 23 соединены беспроводным каналом 32 обмена данными, при этом в качестве навигационных маркерных элементов используют светоизлучающие маяки 87, установленные на опорной плоскости, а бортовая локационная система выполнена с возможностью определения направлений на светоизлучающие маяки 87.In addition, the transport robot according to the first embodiment contains
Кроме того, беспроводной канал 32 обмена данными может содержать первую, вторую и третью пары приемопередатчиков 41, 42 и 43, при этом первые приемопередатчики 44, 45 и 46 первой, второй и третьей пар 41, 42 и 43 приемопередатчиков могут быть смонтированы на платформе 1, а вторые приемопередатчики 47, 48 и 49 из первой, второй и третьей пар 41, 42 и 43 приемопередатчиков могут быть смонтированы на валах 17, 35 и 36 вилок 8, 9 и 10 первого, второго и третьего колес 2, 3 и 4 соответственно, с возможностью взаимодействия с первыми 44, 45 и 46 приемопередатчиками соответствующей пары приемопередатчиков.In addition, the wireless communication channel 32 may include a first, second and third pair of transceivers 41, 42 and 43, while the
Кроме того, первая часть 39 элементов бортовой вычислительной сети 23 может содержать головной контроллер 50, контроллеры 51, 52 и 53 управления поворотными электродвигателями 15, 24 и 25 первого, второго и третьего колес 2, 3 и 4 и первый контроллер 78 бортовой локационной системы, а вторая часть 40 элементов бортовой вычислительной сети 23 может содержать контроллеры 54, 55 и 56 управления маршевыми электродвигателями 19, 26 и 27 первого, второго и третьего колес 2, 3 и 4.In addition, the first part 39 of the components of the on-board computer network 23 may include a
Кроме того, выходные валы 57 и 58 второго и третьего маршевых электродвигателей 26 и 27 могут быть кинематически связаны с валами 6 и 7 второго и третьего колес 3 и 4 соответственно, управляющие входы первого, второго и третьего маршевых электродвигателей 19, 26 и 27 могут быть подключены к управляющим выходам контроллеров 54, 55 и 56, подключенных также к датчикам 21, 30 и 31 скорости вращения первого, второго и третьего колеса 2, 3 и 4 соответственно, а управляющие входы первого, второго и третьего поворотных электродвигателей 15, 24 и 25 могут быть подключены к управляющим выходам контроллеров 51, 52 и 53, подключенных также к датчикам 18, 28 и 29 угла поворота первого, второго и третьего колеса 2, 3 и 4 соответственно.In addition, the
Кроме того, в качестве приемопередатчиков 44-49 могут быть использованы приемопередатчики инфракрасного излучения.In addition, infrared transceivers may be used as transceivers 44-49.
Кроме того, установленные на платформе 1 с возможностью передачи питающего напряжения от источника питания 22 на вал 17, 35 и 36 вилки 8, 9 и 10, вилки 8, 9 и 10 каждого колеса могут быть оснащены соответствующими узлами 59, 60 и 61 передачи электрического сигнала через вращающееся сочленение, при этом каждый узел 59, 60 и 61 передачи электрического сигнала через вращающееся сочленение может содержать смонтированный на платформе 1 подшипник 62, 63 и 64 с установленным в нем валом 17, 35 и 36 вилки 8, 9 и 10, опору 65, 66 и 67 и токоподводящие щетки 68 и 69, 70 и 71 и 72 и 73, установленные на соответствующем валу 17, 35 и 36 с возможностью электрического контакта с соответствующей опорой 65, 66 и 67, электрически соединенной с источником питания 22.In addition, installed on the
Кроме того, транспортный робот по первому варианту может содержать площадку 74 и стойки 91, посредством которых площадка 74 смонтирована на платформе 1 параллельно ей, а бортовая локационная система может содержать установленные на площадке 74 светоотражающий конус 75 и фотообъектив 76 с установленной в фокусной плоскости фотообъектива 76 фотоприемной матрицей 77.In addition, the transport robot according to the first embodiment may comprise a platform 74 and racks 91, by means of which the platform 74 is mounted on the
Кроме того, выход фотоприемной матрицы 77 может быть подключен к входу первого контроллера 78 бортовой локационной системы.In addition, the output of the
Кроме того, в транспортном роботе по первому варианту ось 79 вращения светоотражающего конуса 75 может совпадать с оптической осью 80 фотообъектива 76 и проходить через центр фотоприемной матрицы 77 и центр платформы 1, а одна из осей 81 фотоприемной матрицы 77 может располагаться параллельно горизонтальной оси 82, проходящей из центра платформы 1 через ось 14 вала 17 вилки 8 первого колеса 2.In addition, in the transport robot according to the first embodiment, the
Кроме того, в транспортном роботе по первому варианту угол раскрыва светоотражающего конуса 75 может быть выбран равным 90°.In addition, in the transport robot according to the first embodiment, the opening angle of the
Транспортный робот, содержащий бортовую локационную систему для перемещения в среде с навигационными маркерными элементами по первому варианту, работает следующим образом.A transport robot containing an onboard location system for moving in an environment with navigation marker elements according to the first embodiment works as follows.
Оптический сигнал от светоизлучающего маяка 87 попадает на поверхность светоотражающего конуса 75, отражается от нее и, пройдя через фотообъектив 76, попадает на фотоприемную матрицу 77, установленную в фокальной плоскости фотообъектива 76.The optical signal from the light-
По выходному сигналу фотоприемной матрицы 77, зная координаты xm, ym точки М в плоскости фотоприемной матрицы 77 в соответствии с выражениемAccording to the output signal of the
первый контроллер 78 вычисляет угол α, на который необходимо повернуть платформу 1 относительно ее центра С. После поворота платформы 1 на угол α, ось yфм фотоприемной матрицы 77 будет совпадать с горизонтальной осью 82, проходящей из центра платформы 1 через ось 14 вала 17 вилки 8 первого колеса 2.
Развернув теперь первое колесо 2 в положение β1=0, выставив второе и третье колеса 3 и 4 параллельно первому колесу 2 и задав одинаковую скорость вращения всех трех колес 2, 3 и 4, мы обеспечим движение транспортного робота на светоизлучающий маяк 87.Having now deployed the
Головной контроллер 50 задает сигналы требуемых углов поворота и скоростей вращения колес 2, 3 и 4. Эти сигналы преобразуются контроллерами 51, 52 и 53 управления поворотными электродвигателями и контроллерами 54, 55 и 56 управления маршевыми электродвигателями в управляющие сигналы поворотных электродвигателей 15, 24 и 25 и маршевых электродвигателей 19, 26 и 27 соответственно.The
Текущие значения углов поворота колес 2, 3 и 4 измеряются датчиками 18, 28 и 29 углов поворота колес и передаются в контроллеры 51, 52 и 53, где сравниваются с требуемыми значениями. Аналогично, текущие значения скоростей вращения колес 2, 3 и 4 измеряются датчиками скорости вращения 21, 30 и 31 и передаются в контроллеры 54, 55 и 56, где сравниваются с заданными значениями скоростей.The current values of the angle of rotation of the
Контроллеры 54, 55 и 56, управляющие маршевыми двигателями 19, 26 и 27 колес 2, 3 и 4, установлены непосредственно на вилках 8, 9 и 10 колес 2, 3 и 4, а их связь с контроллерами 51, 52 и 53 первой части 39 элементов бортовой вычислительной сети 23, размещенными на платформе 1, осуществляется посредством инфракрасных каналов 41, 42 и 43, образованных парами ПК-приемопередатчиков 44 и 47, 45 и 48, 46 и 49.The
Передача питания от источника питания 22 на маршевые электродвигатели 19, 26 и 27 осуществляется с помощью соответствующих пар токоподводящих скользящих щеток 68 и 69, 70 и 71 и 72 и 73, размещаемых на вертикальном валу 17, 35 и 36 вилки 8, 9 и 10.The power is transmitted from the
Таким образом, благодаря размещению осей 14, 33 и 34 вилок 8, 9 и 10 в вершинах равностороннего треугольника, обеспечению передачи питания на маршевые электродвигатели 19, 26 и 27 через узлы 59, 60 и 61 передачи электрического сигнала через вращающееся сочленение и осуществлению обмена информацией между контроллерами 50-56 бортовой вычислительной сети 23 по беспроводному каналу 32 обмена данными, удается обеспечить транспортному роботу расширенные кинематические возможности по сравнению с транспортным роботом, выбранным в качестве прототипа.Thus, due to the placement of the
Для данного транспортного робота движение центра платформы 1 и ее угловое движение можно сделать независимыми, например заставить перемещаться платформу 1 поступательно, не меняя ее ориентации, вращаться на месте и т.д.For a given transport robot, the movement of the center of
Таким образом, указанные отличительные особенности транспортного робота по первому варианту повышают его маневренность и обеспечивают возможность его движения по навигационным маркерным элементам независимо от уровня электромагнитных полей.Thus, these distinctive features of the transport robot according to the first embodiment increase its maneuverability and provide the possibility of its movement along the navigation marker elements, regardless of the level of electromagnetic fields.
Транспортный робот, содержащий бортовую локационную систему для перемещения в среде с навигационными маркерными элементами по второму варианту, включает платформу 1, первое, второе и третье колеса 2, 3 и 4, первый, второй и третий вал 5, 6 и 7, со смонтированными на соответствующих валах 5, 6 и 7 первым, вторым и третьим колесами 2, 3 и 4, установленные на платформе 1 вилки первого, второго и третьего колеса 8, 9 и 10 со смонтированными в них с возможностью вращения относительно горизонтальных осей 11, 12 и 13 вилок 8, 9 и 10 валами 5, 6 и 7 первого, второго и третьего колес 2, 3 и 4 соответственно, причем вилка 8 первого колеса 2 установлена с возможностью поворота вокруг вертикальной оси 14 первой вилки 8, поворотный электродвигатель 15 первого колеса 2, выходной вал 16 которого кинематически связан с валом 17 вилки 8 первого колеса 2, и датчик 18 угла поворота первого колеса 2, установленные на платформе 1 маршевый электродвигатель 19 первого колеса 2, выходной вал 20 которого кинематически связан с валом 5 первого колеса 2, датчик 21 скорости вращения первого колеса 2 и источник питания 22, а также бортовую вычислительную сеть 23.A transport robot containing an onboard location system for moving in an environment with navigation marker elements according to the second embodiment includes a
Кроме того, беспроводной канал 32 обмена данными может содержать первую, вторую и третью пары приемопередатчиков 41, 42 и 43, при этом первые приемопередатчики 44, 45 и 46 первой, второй и третьей пар 41, 42 и 43 приемопередатчиков могут быть смонтированы на платформе 1, а вторые приемопередатчики 47, 48 и 49 из первой, второй и третьей пар 41, 42 и 43 приемопередатчиков могут быть смонтированы на валах 17, 35 и 36 вилок 8, 9 и 10 первого, второго и третьего колес 2, 3 и 4 соответственно, с возможностью взаимодействия с первыми 44, 45 и 46 приемопередатчиками соответствующей пары приемопередатчиков.In addition, the wireless communication channel 32 may include a first, second and third pair of transceivers 41, 42 and 43, while the
Кроме того, первая часть 39 элементов бортовой вычислительной сети 23 может содержать головной контроллер 50, контроллеры 51, 52 и 53 управления поворотными электродвигателями 15, 24 и 25 первого, второго и третьего колес 2, 3 и 4 и первый контроллер 78 бортовой локационной системы, а вторая часть 40 элементов бортовой вычислительной сети 23 может содержать контроллеры 54, 55 и 56 управления маршевыми электродвигателями 19, 26 и 27 первого, второго и третьего колес 2, 3 и 4.In addition, the first part 39 of the components of the on-board computer network 23 may include a
Кроме того, выходные валы 57 и 58 второго и третьего маршевых электродвигателей 26 и 27 могут быть кинематически связаны с валами 6 и 7 второго и третьего колес 3 и 4 соответственно, управляющие входы первого, второго и третьего маршевых электродвигателей 19, 26 и 27 могут быть подключены к управляющим выходам контроллеров 54, 55 и 56, подключенных также к датчикам 21, 30 и 31 скорости вращения первого, второго и третьего колеса 2, 3 и 4 соответственно, а управляющие входы первого, второго и третьего поворотных электродвигателей 15, 24 и 25 могут быть подключены к управляющим выходам контроллеров 51, 52 и 53, подключенных также к датчикам 18, 28 и 29 угла поворота первого, второго и третьего колеса 2, 3 и 4 соответственно.In addition, the
Кроме того, в качестве приемопередатчиков 44-49 могут быть использованы приемопередатчики инфракрасного излучения.In addition, infrared transceivers may be used as transceivers 44-49.
Кроме того, установленные на платформе 1 с возможностью передачи питающего напряжения от источника питания 22 на вал 17, 35 и 36 вилки 8, 9 и 10, вилки 8, 9 и 10 каждого колеса могут быть оснащены соответствующими узлами 59, 60 и 61 передачи электрического сигнала через вращающееся сочленение, при этом каждый узел 59, 60 и 61 передачи электрического сигнала через вращающееся сочленение может содержать смонтированный на платформе 1 подшипник 62, 63 и 64 с установленным в нем валом 17, 35 и 36 вилки 8, 9 и 10, опору 65, 66 и 67 и токоподводящие щетки 68 и 69, 70 и 71 и 72 и 73, установленные на соответствующем валу 17, 35 и 36 с возможностью электрического контакта с соответствующей опорой 65, 66 и 67, электрически соединенной с источником питания 22.In addition, installed on the
Кроме того, в транспортном роботе по второму варианту может быть дополнительно введен кронштейн 83, жестко закрепленный на валу 17 вилки 8 первого колеса 2 таким образом, что вертикальная плоскость симметрии кронштейна 83 совпадает с расположенной перпендикулярно оси 11 вращения первого колеса 2 вертикальной плоскостью симметрии первого колеса 2, а бортовая локационная система может содержать оптронную линейку 84, лампу подсветки 85 и второй контроллер 86 бортовой локационной системы, причем оптронная линейка 84 и лампа подсветки 85 могут быть смонтированы на кронштейне 83 параллельно опорной плоскости и параллельно оси 11 вращения первого колеса 2.In addition, in the transport robot according to the second embodiment, an
Кроме того, для транспортного робота по второму варианту выходы оптронной линейки 84 могут быть подключены к соответствующим входам второго контроллера 86 бортовой локационной системы, подключенного к соответствующему входу контроллера 54 управления маршевым электродвигателем 19 первого колеса 2.In addition, for the transport robot according to the second embodiment, the outputs of the
Транспортный робот с бортовой локационной системой для перемещения в среде, снабженной навигационными маркерными элементами по второму варианту, работает следующим образом.A transport robot with an onboard location system for moving in an environment equipped with navigation marker elements according to the second embodiment operates as follows.
С оптронной линейки 84 снимается сигнал А, пропорциональный расстоянию LB от центра оптронной линейки 84 (точка L), до точки В на средней линии 89 светоконтрастной полосы 88 (фиг.11).Signal A, which is proportional to the distance LB from the center of the optocoupler line 84 (point L), to point B on the
В исходном положении (фиг.11, 12) транспортный робот неподвижен. Его колеса 2, 3 и 4 находятся в положении, при котором оси 11, 12 и 13 вращения валов 5, 6 и 7 колес 2, 3 и 4 пересекаются в одной точке Р, называемой точкой мгновенных скоростей. При этом углы поворота колес 2, 3 и 4 относительно оси x' 94 равны соответственно β1, β2 и β3.In the initial position (11, 12), the transport robot is stationary. Its
На поворотные электродвигатели 24 и 25 с контроллеров 52 и 53 подаем сигналы, устанавливающие колеса 3 и 4 в положение β2=60° и β3=120°. Сигналом с контроллера 51 устанавливаем первое колесо 2 в положение β2=0°. Платформа 1 после этого принимает положение и ориентацию, показанные на фиг.13.We give signals to
Подавая с контроллеров 55 и 56 одинаковые по напряжению сигналы на второй и третий маршевые электродвигатели 26 и 27, осуществляем поворот платформы 1 вокруг точки C1. Эти сигналы подаются до достижения сигналом А минимального значения Δmin. Из фиг.14 очевидно, что Δ=Δmin, когда оптронная линейка 84 установлена перпендикулярно светоконтрастной полосе 88.Feeding the same voltage signals from the
На поворотные электродвигатели 24 и 25 с контроллеров 51, 52 и 53 подаем сигналы, устанавливающие колеса 2, 3 и 4 в положение β1=β2=β3=90°. Платформа 1 после этого принимает положение и ориентацию, показанные на фиг.15.We give signals to
Подавая с контроллеров 51, 55 и 56 одинаковые по напряжению сигналы на первый, второй и третий маршевые электродвигатели 19, 26 и 27, осуществляем движение платформы 1 перпендикулярно оси ОХ. Эти сигналы подаются до достижения сигналом Δmin значения 0. Из фиг.16 очевидно, что Δmin=0, когда платформа 1 принимает положение, показанное на фиг.16. Установив теперь колеса робота в положение β1=β2=β3=0° и подавая после этого с контроллеров 51, 55 и 56 одинаковые по напряжению сигналы на первый, второй и третий маршевые электродвигатели 19, 26 и 27, осуществляем движение платформы 1 вдоль светоконтрастной полосы 88.By supplying the same voltage signals from the
Таким образом, благодаря размещению осей 14, 33 и 34 вилок 8, 9 и 10 в вершинах равностороннего треугольника, обеспечению передачи питания на маршевые электродвигатели 19, 26 и 27 через узлы 59, 60 и 61 передачи электрического сигнала через вращающееся сочленение и осуществлению обмена информацией между контроллерами 50-56 бортовой вычислительной сети 23 по беспроводному каналу 32 обмена данными, удается обеспечить транспортному роботу расширенные кинематические возможности по сравнению с транспортным роботом, выбранным в качестве прототипа.Thus, due to the placement of the
Как было показано выше, для данного транспортного робота движение центра платформы 1 и ее угловое движение можно сделать независимыми, например заставить перемещаться платформу 1 поступательно, не меняя ее ориентации, вращаться на месте и т.д.As shown above, for a given transport robot, the movement of the center of the
Все это в целом повышает маневренность транспортного робота.All this as a whole increases the maneuverability of the transport robot.
Построение бортовой локационной системы на принципах оптической локации и использование в качестве датчиков локационной системы фотоприемных элементов в виде фотоприемных матриц и оптронных линеек делает ее нечувствительной к электромагнитным полям от работающего в цехах промышленных предприятий оборудования.The construction of an onboard location system based on the principles of optical location and the use of photodetector elements in the form of photodetector arrays and optical arrays as sensors of the location system makes it insensitive to electromagnetic fields from equipment operating in workshops of industrial enterprises.
Таким образом, описанные выше существенные отличия повышают маневренность и расширяют функциональные возможности транспортного робота за счет обеспечения возможности определять направление и осуществлять движение на навигационные маркерные элементы и осуществлять движение по светоконтрастной полосе на полу в цехах промышленных предприятий в присутствии сильных электромагнитных полей от работающего оборудования.Thus, the significant differences described above increase the maneuverability and expand the functionality of the transport robot by providing the ability to determine the direction and move to navigation marker elements and to move along the light-contrast strip on the floor in the shops of industrial enterprises in the presence of strong electromagnetic fields from operating equipment.
Проведенные заявителем патентные исследования показали, что аналогов приведенным существенным отличиям нет.The patent studies carried out by the applicant have shown that there are no analogues to the significant differences.
Claims (18)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2010116011/02A RU2454314C2 (en) | 2010-04-23 | 2010-04-23 | Transportation robot having on-board location system (versions) |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
RU2010116011/02A RU2454314C2 (en) | 2010-04-23 | 2010-04-23 | Transportation robot having on-board location system (versions) |
Publications (2)
Publication Number | Publication Date |
---|---|
RU2010116011A RU2010116011A (en) | 2011-10-27 |
RU2454314C2 true RU2454314C2 (en) | 2012-06-27 |
Family
ID=44997819
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
RU2010116011/02A RU2454314C2 (en) | 2010-04-23 | 2010-04-23 | Transportation robot having on-board location system (versions) |
Country Status (1)
Country | Link |
---|---|
RU (1) | RU2454314C2 (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2506157C1 (en) * | 2012-11-06 | 2014-02-10 | Открытое акционерное общество "Завод им. В.А. Дегтярева" | Robot transport platform |
RU2557085C1 (en) * | 2014-05-28 | 2015-07-20 | Общество с ограниченной ответственностью "Подводгазэнергосервис" | Apparatus for controlling robotic vehicle |
RU2556693C1 (en) * | 2014-06-04 | 2015-07-20 | Открытое акционерное общество "Горьковский завод аппаратуры связи им. А.С. Попова" | Mobile ground-based homing system (versions) |
CN105690362A (en) * | 2016-04-14 | 2016-06-22 | 林飞飞 | Multifunctional palletizing robot based on Stewart parallel connection platform |
CN113119065A (en) * | 2021-06-17 | 2021-07-16 | 中国人民解放军国防科技大学 | Multi-degree-of-freedom mechanical arm, moving platform and rescue robot |
RU2798652C1 (en) * | 2022-06-20 | 2023-06-23 | Федеральное государственное бюджетное научное учреждение "Федеральный научный центр "КАБАРДИНО-БАЛКАРСКИЙ НАУЧНЫЙ ЦЕНТР РОССИЙСКОЙ АКАДЕМИИ НАУК" (КБНЦ РАН) | Highly mobile transport robot for moving palletized goods |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10051414B1 (en) * | 2017-08-30 | 2018-08-14 | Cognitive Systems Corp. | Detecting motion based on decompositions of channel response variations |
US10754349B2 (en) | 2018-05-31 | 2020-08-25 | Toyota Research Institute, Inc. | Robot systems providing bump detection and robots incorporating the same |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5219264A (en) * | 1986-09-19 | 1993-06-15 | Texas Instruments Incorporated | Mobile robot on-board vision system |
US5534762A (en) * | 1993-09-27 | 1996-07-09 | Samsung Electronics Co., Ltd. | Self-propelled cleaning robot operable in a cordless mode and a cord mode |
RU2130618C1 (en) * | 1994-03-28 | 1999-05-20 | Джервис Б.Уэбб Интернэшнл Компани Уолд Хедкватерс | Device for determination of position of transport facility and sensor unit used in it |
RU2210492C2 (en) * | 2000-11-17 | 2003-08-20 | Самсунг Кванджу Электроникс Ко., Лтд. | Mobile robot and method for correcting its motion course |
RU2303240C1 (en) * | 2006-03-02 | 2007-07-20 | ГОУ ВПО Московский государственный университет инженерной экологии | Mode of definition of a spatial position and an angular orientation of the trolley of a transport vehicle |
-
2010
- 2010-04-23 RU RU2010116011/02A patent/RU2454314C2/en active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5219264A (en) * | 1986-09-19 | 1993-06-15 | Texas Instruments Incorporated | Mobile robot on-board vision system |
US5534762A (en) * | 1993-09-27 | 1996-07-09 | Samsung Electronics Co., Ltd. | Self-propelled cleaning robot operable in a cordless mode and a cord mode |
RU2130618C1 (en) * | 1994-03-28 | 1999-05-20 | Джервис Б.Уэбб Интернэшнл Компани Уолд Хедкватерс | Device for determination of position of transport facility and sensor unit used in it |
RU2210492C2 (en) * | 2000-11-17 | 2003-08-20 | Самсунг Кванджу Электроникс Ко., Лтд. | Mobile robot and method for correcting its motion course |
RU2303240C1 (en) * | 2006-03-02 | 2007-07-20 | ГОУ ВПО Московский государственный университет инженерной экологии | Mode of definition of a spatial position and an angular orientation of the trolley of a transport vehicle |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2506157C1 (en) * | 2012-11-06 | 2014-02-10 | Открытое акционерное общество "Завод им. В.А. Дегтярева" | Robot transport platform |
RU2557085C1 (en) * | 2014-05-28 | 2015-07-20 | Общество с ограниченной ответственностью "Подводгазэнергосервис" | Apparatus for controlling robotic vehicle |
RU2556693C1 (en) * | 2014-06-04 | 2015-07-20 | Открытое акционерное общество "Горьковский завод аппаратуры связи им. А.С. Попова" | Mobile ground-based homing system (versions) |
RU2556693C9 (en) * | 2014-06-04 | 2015-10-10 | Открытое акционерное общество "Горьковский завод аппаратуры связи им. А.С. Попова" | Mobile ground-based homing system (versions) |
CN105690362A (en) * | 2016-04-14 | 2016-06-22 | 林飞飞 | Multifunctional palletizing robot based on Stewart parallel connection platform |
CN113119065A (en) * | 2021-06-17 | 2021-07-16 | 中国人民解放军国防科技大学 | Multi-degree-of-freedom mechanical arm, moving platform and rescue robot |
RU2798652C1 (en) * | 2022-06-20 | 2023-06-23 | Федеральное государственное бюджетное научное учреждение "Федеральный научный центр "КАБАРДИНО-БАЛКАРСКИЙ НАУЧНЫЙ ЦЕНТР РОССИЙСКОЙ АКАДЕМИИ НАУК" (КБНЦ РАН) | Highly mobile transport robot for moving palletized goods |
Also Published As
Publication number | Publication date |
---|---|
RU2010116011A (en) | 2011-10-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
RU2454314C2 (en) | Transportation robot having on-board location system (versions) | |
JP6813639B2 (en) | Equipment and methods for rotary joints with multiple radio links | |
CN113029117B (en) | Flight sensor | |
JP6637068B2 (en) | Modular LIDAR system | |
CN110073238A (en) | Light detection and ranging (LIDAR) equipment with multiple receivers | |
WO2014068406A2 (en) | Device for optically scanning and measuring an environment | |
CN108496300A (en) | Motor position senses | |
JP6448071B2 (en) | Drone | |
CN108398696A (en) | Multi-thread rotary laser radar installations | |
CN104808675A (en) | Intelligent terminal-based somatosensory flight operation and control system and terminal equipment | |
CN104102222A (en) | Accurately positioning method for AGV (Automatic Guided Vehicle) | |
CN104503339A (en) | Multi-resolution indoor three-dimensional scene reconstitution device and method based on laser radar and quadrotor | |
Ohno et al. | Development of 3D laser scanner for measuring uniform and dense 3D shapes of static objects in dynamic environment. | |
US20200159241A1 (en) | Automated vehicle | |
US10870391B2 (en) | Devices and methods for optical communication in a rotary platform | |
RU2454313C2 (en) | Mobile robot having self-contained navigation system (versions) | |
CN105874349A (en) | Detection device, detection system, detection method, and removable device | |
WO2018110516A1 (en) | Wall-climbing robot | |
CN103777630A (en) | Positioning navigation system and control method thereof | |
CN111251271B (en) | SLAM robot for constructing and positioning rotary laser radar and indoor map | |
Piemngam et al. | Development of autonomous mobile robot platform with mecanum wheels | |
EP3904205A1 (en) | A method for controlling a motor and a system | |
US11909263B1 (en) | Planar rotary transformer | |
RU2424891C1 (en) | Transport robot | |
CN208156197U (en) | Multi-thread rotary laser radar installations |