Архитектура системы управления мобильным роботом

Изобретение относится к области управления мобильными робототехническим комплексами, в частности мобильными роботами. Сущность изобретения состоит в том, что система управления мобильным роботом имеет иерархическую архитектуру, притом каждое устройство, входящее в систему, имеет связь с остальными устройствами посредством двух магистралей: шины команд и шины данных. Каждое устройство системы имеет процессор или микроконтроллер. Расположение всех данных в оперативной памяти, подключенной к процессору или микроконтроллеру устройства системы управления, имеет вид регистров команд и регистров данных. Передача информации регистров команд выполняется в виде отправки и приема сообщений по шине команд, передача информации регистров данных выполняется в виде отправки и приема сообщений по шине данных. Устройство, формирующее команды, и устройство, формирующее данные, инициируют передачу команд и данных соответственно и определяют частоту обновления значений регистров устройств-получателей. Данная архитектура системы управления мобильным роботом позволяет устройствам, входящим в систему управления, асинхронно и независимо друг от друга отправлять и принимать команды управления и данные. При использовании отдельных шин команд и данных исключаются коллизии при передаче команд и данных по единой магистрали, а также появляется возможность увеличения скорости передачи команд и данных. 2 ил.

 

Изобретение относится к области управления мобильными робототехническим комплексами, в частности мобильными роботами.

Известно устройство программного управления (заявка на изобретение 94025187/09, 04.07.1994 г., дата публикации 27.05.1996 г.), в котором к единой информационной магистрали подключены: устройство ввода программы, контроллер прерываний, вычислитель, перепрограммируемое запоминающее устройство, контроллер пульта оператора, цифровая система импульсно-фазового управления. В устройство входят также тиристорный преобразователь, датчики проводимости и тока, электродвигатель, датчики скорости и положения, блок электроавтоматики.

Недостатком данного устройства программного управления является наличие единой информационной магистрали для передачи и приема управляющих команд и данных устройствами, входящими в систему устройства программного управления.

Задача изобретения: усовершенствование архитектуры системы управления с целью исключения коллизий при передаче команд и данных по единой магистрали, а также получения возможности увеличения скорости передачи команд и данных.

Задача решается тем, что система управления мобильным роботом имеет иерархическую архитектуру, притом каждое устройство, входящее в систему, имеет связь с остальными устройствами посредством двух магистралей: шины команд и шины данных (фиг. 1). Обмен информацией между всеми устройствами, подключенными к шине команд и шине данных, выполняется отправкой и приемом сообщений, причем каждый кадр сообщений имеет формат последовательности байтов (фиг. 2).

В системе управления мобильным роботом каждое нижестоящее устройство системы подчиняется вышестоящему посредством управляющих команд. Передача управляющих команд в системе осуществляется от вышестоящего устройства к нижестоящему устройству (нескольким нижестоящим устройствам) посредством шины команд, а передача данных выполняется от устройства-формирователя данных к устройствам-получателям (вышестоящим устройствам, нижестоящим устройствам и устройствам сходного уровня иерархии с устройством-формирователем данных) посредством шины данных, притом передача команд и данных возможна непосредственно устройству-получателю минуя промежуточные устройства благодаря тому, что команды и данные передаются через шину команд и шину данных соответственно, причем при такой организации шин возможна широковещательная передача команд и данных от одного устройства-источника нескольким устройствам-получателям (фиг. 1).

Самым верхним уровнем иерархии устройств является первый уровень (рис. 1). Устройство первого уровня иерархии является вышестоящим для всех остальных устройств системы управления. Минимальное количество устройств в системе управления мобильным роботом равно двум, причем только одно из устройств может иметь первый уровень в иерархии устройств системы управления. Уровень иерархии устройства понижается с увеличением номера уровня устройства.

Физический уровень шинных интерфейсов системы управления – дифференциальная пара (последовательный интерфейс), что обеспечивает высокую устойчивость передаваемого сигнала к синфазной помехе.

Каждое устройство системы управления имеет процессор или микроконтроллер, выполняющий передачу/прием команд и данных, сбор, обработку и хранение данных датчиков физических величин, управление приводами или исполнительными устройствами робота, передачу/прием информации посредством радиосвязи. Расположение всех данных в оперативной памяти, подключенной к процессору/микроконтроллеру устройства системы управления имеет вид одномерных массивов постоянной длины. Каждый элемент такого массива является местом хранения текущего значения некоторой величины в цифровой форме, отражающей сведения:

- об управляющих командах, переданных нижестоящим элементам системы управления,

- о состоянии мобильного робота и окружающей его среды (данные, полученные от датчиков, процессоров/микроконтроллеров).

Каждая величина занимает в статическом одномерном массиве фиксированную и неперемещаемую область памяти – регистр, переход к которому осуществляется посредством указания константного индекса (номера) нужного элемента массива.

Все регистры делятся на две группы:

- регистры команд,

- регистры данных.

Регистры отправляемых команд располагаются в оперативной памяти устройства, формирующего команды (вышестоящего устройства) и доступны только ему для чтения и записи. В оперативной памяти нижестоящих устройств располагаются регистры принимаемых команд вышестоящего устройства – вышестоящее устройство имеет возможность записи команд в регистры подчиненного устройства, при этом нижестоящему устройству доступно только чтение своих регистров принимаемых команд.

Регистры отправляемых данных располагаются в оперативной памяти устройств, формирующих эти данные и доступны только им для чтения и записи. Регистры принимаемых данных находятся в оперативной памяти устройств-получателей, и доступны им только для чтения – устройство-формирователь данных имеет возможность записи данных в регистры принимаемых данных этих устройств.

Регистры команд и регистры данных размещаются в массивах регистров команд и массивах регистров данных соответственно. Передача информации регистров команд выполняется в виде отправки и приема сообщений по шине команд, передача информации регистров данных выполняется в виде отправки и приема сообщений по шине данных.

Кадр каждого сообщения команд/данных имеет формат последовательности байтов (фиг. 2), включающей в себя:

- начало сообщения (преамбула) – является идентификатором (маркером) начала сообщения; преамбула также может включать информацию о том, что данные сообщения должны быть записаны в определенные типы (модули) памяти, или о том, что текущее сообщение является запросом/разрешением на передачу данных;

- идентификатор оригинальности сообщения – сообщение может быть либо оригинальным (от устройства-отправителя устройству-получателю), либо эхо-сообщением (от устройства-получателя устройству-отправителю);

- идентификатор устройства-получателя, кому адресованы команда или данные;

- идентификатор устройства-отправителя;

- значение длины фрагментов данных кадра сообщения в количестве байтов (указывается суммарная длина фрагментов кадра, которыми являются номера регистров команд и их значений или номера регистров данных и их значений);

- один или несколько последовательно идущих друг за другом фрагментов данных кадра сообщения;

- контрольная сумма всего кадра сообщения.

Архитектура системы управления мобильным роботом работает следующим образом.

Устройство, формирующее команды, и устройство, формирующее данные, инициируют передачу команд и данных соответственно. Таким образом, эти устройства определяют частоту обновления значений регистров принимаемых данных устройств-получателей.

Для обеспечения обнаружения и устранения появления коллизий при передаче данных/команд между устройствами передающее устройство должно перед передачей команд/данных определить присутствие сигнала (помехи) другого устройства в передающей среде (шине). Если помеха от другого устройства присутствует в передающей среде, передающее устройство откладывает передачу, транслирует через шину команд/данных специальное сообщение помехи, сообщающее всем устройствам, подключенным к шине, о необходимости завершения ими передач и ожидает некоторый период времени, перед тем как возобновить свою передачу.

Контроль ошибок передачи команд/данных выполняется двумя способами:

- устройство-получатель транслирует устройству-отправителю ответное эхо-сообщение – устройство-отправитель сравнивает данные (значения регистров и данных/команд) в ответном сообщении с данными в отправленном сообщении и при несовпадении данных устройство-отправитель повторяет трансляцию;

- в конце каждого кадра сообщения размещается контрольная сумма, предназначенная для проверки целостности кадра сообщения, длиной два и более байт – принимая сообщение, устройство-получатель вычисляет контрольную сумму сообщения без учета отправленной контрольной суммы и сравнивает с ней результат своих вычислений: если их значения не совпадают, сообщение игнорируется.

Все регистры имеют одинаковые длины. Для многих задач робототехники длина одного регистра в 2 и 4 байта достаточна – для хранения 16- и 32-разрядных чисел соответственно. Хранимые числа могут быть со знаком и без знака. При длине регистра в 4 байта возможно хранение числа одинарной точности с плавающей запятой. Возможна длина регистра в 8 байт и более.

При необходимости работы с массивами данных размерностью, больше чем единица (двумерный массив, трехмерный массив и т.д.) в регистрах размещаются элементы этих массивов, при этом многомерные массивы имеют фиксированную длину и представляются как одномерный массив массивов. В этом случае устройство-формирователь данных передает многомерные массивы данных устройствам-получателям по частям.

Работа системы управления мобильным роботом, использующей данную архитектуру и состоящей из трех устройств (рис. 1), может выполняться следующим образом.

Устройство 1 уровня 1 формирует и отправляет команды по шине команд устройству 2 и устройству 3 уровня 2: для устройства 2 – команду о запуске приемо-передающим устройством радиосвязи, подключенным к устройству 2, передачи по каналу радиосвязи данных о состоянии мобильного робота на пульт удаленного управления роботом; для устройства 3 – команду о сборе данных с датчиков физических величин, подключенных к устройству 3. Устройство 1 уровня 1 формирует и отправляет команды по шине команд устройству N уровня N: команду о сборе данных с датчиков физических величин, подключенных к устройству N и команду о формировании устройством N управляющих импульсов для драйверных схем управления приводами или схем управления исполнительными устройствами, которые подключены к устройству N. Устройство 1 уровня 1 является вышестоящим для устройства 2 и устройства 3 уровня 2, устройства N уровня N.

Устройство 3 уровня 2 и устройство N уровня N формируют и отправляют поочередно данные по шине данных устройству 1 уровня 1 и устройству 2 уровня 2. Шина данных выполняет функцию обратной связи в системе управления мобильным роботом.

Данная архитектура системы управления мобильным роботом позволяет устройствам, входящим в систему управления, асинхронно и независимо друг от друга отправлять и принимать команды управления и данные. При использовании отдельных шин команд и данных исключаются коллизии при передаче команд и данных по единой магистрали, а также появляется возможность увеличения скорости передачи команд и данных.

Архитектура системы управления мобильным роботом, состоящая из устройств, подключенных к единой информационной магистрали, отличающаяся тем, что система управления мобильным роботом имеет иерархическую архитектуру, при этом каждое нижестоящее устройство системы подчиняется вышестоящему посредством выполнения команд, передаваемых от вышестоящего устройства к нижестоящему устройству или нескольким нижестоящим устройствам посредством шины команд, а передача данных выполняется посредством шины данных от устройства-формирователя данных к устройствам-получателям, которыми могут быть вышестоящие устройства, нижестоящие устройства и устройства сходного уровня иерархии с устройством-формирователем данных, при этом самым верхним уровнем иерархии устройств является первый уровень, причем устройство первого уровня иерархии является вышестоящим для всех остальных устройств системы управления, притом минимальное количество устройств в системе управления мобильным роботом равно двум, причем только одно из устройств может иметь первый уровень в иерархии устройств системы управления, при этом уровень иерархии устройства понижается с увеличением номера уровня устройства, притом передача команд и данных возможна непосредственно устройству-получателю, минуя промежуточные устройства благодаря тому, что команды и данные передаются через шину команд и шину данных соответственно, причем при такой организации шин возможна широковещательная передача команд и данных от одного устройства-источника нескольким устройствам-получателям, при этом физическим уровнем шинных интерфейсов системы управления является дифференциальная пара, что обеспечивает высокую устойчивость передаваемого сигнала к синфазной помехе, притом каждое устройство системы имеет процессор или микроконтроллер, выполняющий передачу и прием команд и данных, сбор, обработку и хранение данных датчиков физических величин, управление приводами или исполнительными устройствами робота, передачу и прием информации посредством радиосвязи, при этом к процессору или микроконтроллеру подключена оперативная память, расположение всех данных в которой имеет вид регистров команд и регистров данных, причем передача информации регистров команд выполняется отправкой и приемом сообщений по шине команд, передача информации регистров данных выполняется отправкой и приемом сообщений по шине данных, при этом устройство, формирующее команды, и устройство, формирующее данные, инициируют передачу команд и данных соответственно так, что эти устройства определяют частоту обновления значений регистров устройств-получателей, причем каждый кадр сообщений команд и данных имеет формат последовательности байтов, включающей в себя: начало сообщения, которое является идентификатором начала сообщения и может включать информацию о том, что данные сообщения должны быть записаны в определенные типы памяти, и о том, что текущее сообщение является запросом или разрешением на передачу данных; идентификатор оригинальности сообщения, который показывает, что сообщение является оригинальным и отправлено от устройства-отправителя устройству-получателю либо является эхо-сообщением и отправлено от устройства-получателя устройству-отправителю; идентификатор устройства-получателя, кому адресованы команда или данные; идентификатор устройства-отправителя; значение длины фрагментов данных кадра сообщения в количестве байтов, в котором указывается суммарная длина фрагментов данных кадра сообщения, которыми являются номера регистров команд и их значений или номера регистров данных и их значений; фрагменты данных кадра сообщения, которыми являются один или несколько последовательно идущих друг за другом фрагментов данных кадра сообщения; контрольная сумма всего кадра сообщения, предназначенная для проверки целостности кадра сообщения.



 

Похожие патенты:

Изобретение относится к системам управления. Контролирующий пункт ввода-вывода дискретных сигналов состоит из корпуса, содержащего блоки питания, преобразователи последовательных интерфейсов RS-485, коммутаторы Ethernet.

Группа изобретений относится к системам, управляемым вычислительными устройствами. Масштабируемая система бытовой автоматизации для мониторинга, управления и контроля санитарной установки и элементов, которые содержит санитарная установка, подключаемыми устройствами, которые поддерживают связь друг с другом по сети системы.

Изобретение относится к системе и способу управления окнами. Технический результат заключается в обеспечении обмена данными между независимыми системами, принимающими участие в управлении функциями зданий, имеющих устройства с изменяемыми оптическими свойствами.

Изобретение относится к вычислительной технике. Технический результат заключается в повышении надежности электрической системы.

Группа изобретений относится к системам управления. Способ индивидуального управления нагрузками заключается в следующем.

Изобретение относится к области вычислительной техники. Технический результат заключается в обеспечении надежного контроля, управления и регулирования технических процессов.

Изобретение относится к бытовому прибору для обработки объектов, содержащему управляющее устройство и манипуляторное устройство в виде сенсорного экрана. Технический результат заключается в повышении эффективности работы бытового прибора, например в оптимальном потреблении электрической энергии и расходных материалов, за счет обеспечения возможности введения оптимальных настроек и достигается тем, что управляющее устройство выполнено таким образом, чтобы при прикосновении к первому манипуляторному элементу между панелями В1 и В2 индикации появлялась панель В3 индикации, на которой на третьих манипуляторных элементах отображены по меньшей мере некоторые программные параметры и их неизменяемые или изменяемые значения параметров, причем при прикосновении к третьему манипуляторному элементу, соответствующему изменяемому значению параметра, предусмотрена возможность непосредственного или опосредованного открытия панели В2 индикации, причем, кроме того, управляющее устройство выполнено с возможностью непосредственного запуска программы обработки на панели В1 индикации посредством прикосновения к предусмотренной для этого области первого манипуляторного элемента.

Группа изобретений относится к средствам диагностики устройств управления. Технический результат – уменьшение энергопотребления для диагностики устройства управления.

Группа изобретений относится к управлению электрическими стеклоподъемниками для транспортного средства. Транспортное средство содержит множество окон, переключатель и контроллер.

Изобретение относится к вычислительной технике. Технический результат − расширение эксплуатационных возможностей электроустановки, повышение надежности электрической системы.

Изобретение относится к области управления мобильными робототехническим комплексами, в частности мобильными роботами. Сущность изобретения состоит в том, что система управления мобильным роботом имеет иерархическую архитектуру, притом каждое устройство, входящее в систему, имеет связь с остальными устройствами посредством двух магистралей: шины команд и шины данных. Каждое устройство системы имеет процессор или микроконтроллер. Расположение всех данных в оперативной памяти, подключенной к процессору или микроконтроллеру устройства системы управления, имеет вид регистров команд и регистров данных. Передача информации регистров команд выполняется в виде отправки и приема сообщений по шине команд, передача информации регистров данных выполняется в виде отправки и приема сообщений по шине данных. Устройство, формирующее команды, и устройство, формирующее данные, инициируют передачу команд и данных соответственно и определяют частоту обновления значений регистров устройств-получателей. Данная архитектура системы управления мобильным роботом позволяет устройствам, входящим в систему управления, асинхронно и независимо друг от друга отправлять и принимать команды управления и данные. При использовании отдельных шин команд и данных исключаются коллизии при передаче команд и данных по единой магистрали, а также появляется возможность увеличения скорости передачи команд и данных. 2 ил.

Наверх