способ управления эквидистантным движением транспортного средства и способ определения углового и линейно-бокового отклонения транспортного средства от опорной траектории

Классы МПК:G05D1/02 управление местоположением или курсом в системах двух координат
Автор(ы):, ,
Патентообладатель(и):Гурин Лев Борисович,
Киселев Лев Вениаминович,
Свендровский Александр Романович
Приоритеты:
подача заявки:
1992-11-24
публикация патента:

Ия предназначены для управления движением, преимущественно, наземных транспортных средств (ТС), в том числе и прицепных, с постоянным, в том числе и равным нулю, или изменяющимся по заданному закону расстоянием от некоторой физически заданной на поверхности движения опорной траектории (ОТ) - границы обработанного участка поля, полосы дорожной разметки и т.п. Способ определения линейно-бокового (ЛБО) L и углового (УО) способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 отклонения ТС от ОТ заключается в том, что измеряют с помощью двух оптико-электронных, магнитных или иных датчиков курсовые углы двух не совпадающих "текущих навигационных точек (ТНТ)" опорной траектории, а L и b определяют по выражениям способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 , где способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 - измеренные курсовые углы; r1, r2 - растояния до навигационных точек, r1способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 r2 Наличие раздельной информации о координатах L и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 позволяет реализовать пропорционально- интегральное по угловому и пропорционально-дифференциальное по линейному отклонению ТС от заданной траектории (ЗТ) управление с пониженными статической и динамической ошибками и временем переходного процесса, для чего формируют и поддерживают постоянным или изменяют по заданному закону сигнал, пропорциональный расстоянию между опорной и заданной траекториями, вычитают этот сигнал из сигнала ЛБО, получают сигнал скорости поступательного движения ТС, перемножают сигналы УО и скорости, суммируют указанные разностный сигнал и сигнал произведения и производят соответствующее величине и знаку суммарного сигнала воздействие на управляющие колеса Т.С. Использование не совпадающих ТНТ позволяет также сглаживать при челночном движении случайные искривления ОТ. 2 с. и 2 з.п. ф-лы, 7 ил.
Рисунок 1, Рисунок 2, Рисунок 3, Рисунок 4, Рисунок 5, Рисунок 6, Рисунок 7

Формула изобретения

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

2. Способ по п.1, отличающийся тем, что при управлении движением буксируемого транспортного средства воздействие оказывают на управляющие колеса буксировщика.

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

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

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926

где способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261,способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 измеренные курсовые углы первой и второй текущих навигационных точек соответственно;

r1, r2 расстояния до первой и второй текущих навигационных точек соответственно, r1 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 r2.

Описание изобретения к патенту

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

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

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

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

3. Физически заданную на поверхности движения и используемую для управления движением ТС линию будем называть опорной траекторией ОТ; она может быть прямолинейной и криволинейной. Опорные траектории можно разделить на независимые объективно существующие в природе (например, кромка берега) или искусственно созаднные заранее (например, полоса дорожной разметки) и зависимые создаваеые при каждом предыдущем проходе при "челночном" движении для каждого последующего (например, при движении сельхозагрегатов при пахоте, севе и т.п.).

4. Аналогично, как это принято в навигации, будем рассматривать поступательное движение центра масс (ц.м.) одиночного ТС, считая что именно его эквидистантное движение и должно быть обеспечено, что ТС движется по плоской поверхности и что вектор его скорости всегда лежит в плоскости, параллельной этой поверхности.

Особенности управления эквидистантным движением других точек машины или прицепа также будут отмечены.

5. Точку поверхности (1, фиг.1), над которой в данный момент находится ц. м. ТС, будем называть текущим местом ТС (при отсутствии движения местом ТС).

6. Эквидистантную ОТ линию на поверхности движения, по котрой должно перемещаться место ТС, будем называть заданной траекторией ЗТ).

7. Реально получаемую в процессе движения траекторию места ТС будем называть линией пути (ЛП).

8. Нормальную проекцию места ТС на линии пути (1, фиг.1) на заданную и опорную траектории будем называть местом ТС на ЗТ и ОТ соответственно (1"и 1", фиг.1).

9. Расстояние l между местом ТС на ЗТ и местом ТС на ОТ заданная дистанция (ЗД); расстояние способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l между местом ТС на ЛП и местом ТС на ЗТ линейно-боковое отклонение (ЛБО); сумма l +способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l l L текущая дистанция (ТД).

В частном случае l и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l могут равняться нулю как вместе, так и порознь.

10. Угол способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (/ способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 / способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 0) с вершиной в месте ТС на ЛП между линией, параллельной касательной к ОТ в месте ТС на ОТ и вектором скорости поступательного движения способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 относительный курс (ОК). Если способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 совпадает с продольной осью ТС или параллелен ей, то способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926- также и угловое отклонение (ОУ ТС) от ОТ.

11. Точку (математически), например 2 (фиг.1), или прилежащий к ней отрезок (физически) ОТ, используемую(ый) в данный момент движения для определения способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 и лежащую(ий) на фиксированном расстоянии r от места ТС, будем называть текущей навигационной точкой (ТНТ).

12. Угол способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926зад между касательной к ЗТ с вершиной в месте ТС на 3Т (1) и направлением на соответствующую ей ТНТ (3, фиг.1) заданный курсовой угол ТНТ. Каждой ЗТ соответствует свой (при неизменном r); угол способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т с вершиной в месте ТС на ЛП между направлением на соответствующую (при неизменном r) ТНТ и линией, параллельной касательной к ОТ в месте ТС на ОТ текущий курсовой угол ТНТ; если ЗТ и ЛП совпадают, то способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926зад=способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т угол способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т + способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 суммарный курсовой угол ТНТ.

13. Рыскание ТС периодические колебания ТС в процессе движения относительно ЗТ, вызванные как внешними, так и управляющими воздействиями.

14. Введем понятие непрерывного и дискретного навигационного поля.

Непрерывным будем считать такое поле, в котором невозможно с помощью технических устройств выделить отдельную "силовую линию" (электромагнитное поле всенаправленных радиотехнических устройств, магнитное, световое, температур и давлений и т.п.). Такое поле характеризуется градиентами, относительно которых возможно определение только собственных угловых координат объектов, т.е. углового положения осей связанной с объектом системы координат. Линейная координата объекта в таком поле может быть определена лишь относительно его некоторой эквипотенциальной поверхности (например, высота относительно поверхности с фиксированным давлением).

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

Очевидно, что управление ТС, движущимися по поверхности, может осуществляться с использованием дискретных навигационных полей, положение "силовых линий" которых имеет детерминированную связь с поверхностью движения. Каждая опорная траектория и является такой "силовой линией" дискретного навигационного поля на поверхности движения.

Очевидно, что ТС будет двигаться по эквидистантной относительно опорной заданной траектории, если его центр масс в начале пути находился на ЗТ и вектор скорости способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 в каждый момент движения остается параллельным касательной к ОТ в текущем месте ТС на ОТ.

Такое движение, при котором ЛП совпадает с ЗТ и повторяет ОТ, названо в [1, c.25] следящим.

Очевидно также, что возникновение УО способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (фиг.1) при наличии поступательного движния ТС приводит к изменению заданной дистанции l, иначе к появлению ЛБО способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l, которое (для малых способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 ) может быть определено по выражению

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l C1способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926V(t)способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t)dt (1)

и его изменению со скоростью

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l C2V(t)способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t), (2)

и что последующее уменьшение способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 до нуля (например, за счет управляющего воздействия) приведет к выходу ТС на эквидистантный заданной и опорной траекториям участок ЛП (от точки 4, фиг.1) для которого способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 0.

Известен способ управления движением сельскохозяйственного агрегата по заданной траектории, основанный на измерении только ЛБО способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l. Этот способ реализует известный из теории автоматического управления [2] пропорциональный закон управления, согласно которому управляющее воздействие, прикладываемое к исполнительному органу системы управления, имеет вид

y C3 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l (3)

с неизбежными при его реализации недостатками статической ошибкой и перерегулированием, которые в [1, c.38] отмечены следующим образом: "без точного и независимого от способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l измерения способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 не представляется возможным избавить машину от рыскания" (приведенные обозначения в ссылках здесь и далее наши, соответствующие фиг.1). Объяснение этому дано в [3, c.31]

Известен способ управления движением сельскохозяйственного агрегата, основанный на использовании управляющего сигнала, пропорционального сумме линейной и угловой координат способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l + способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 на практике имеющего вид

y C4(способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 l + способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 ) C4[( способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926зад) + способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926] (4)

что [1, c. 44] "очевидно, повышает качество управления, хотя тот факт, что непосредственное определение способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 исключено, говорит о невозможности обеспечения следящего движения машины без рыскания".

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

Такие системы реализуются, например, в автомобилевождении при выполнении маневра "переставка", азключающегося в смещении ТС на некоторую величину в направлении, перпендикулярном направлению движения (т.е. на новую траекторию, эквидистантную прежней), и выполняемого путем увеличения способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 ) от нуля (например, в т. 5, фиг.1) до некоторого значения и последующего уменьшения его до нуля (участок 5.6, фиг.1) по мере уменьшения способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l, а также в самонаведении, в теории которого участок ЛП 5.6 (фиг.1) носит название "кривая погони".

В [3, c.32] предложен способ управления движением сельхозагрегата, основанный на независимом получении сигналов способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 ) и их независимом же и последовательном устранении. Здесь также реализовался бы пропорциональный закон, но такое управление, очевидно, нереализуемо, так как после устранения способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l невозможно поступательное движение строго по ЗТ с способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926lспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 0, хотя постепенно и снижающимся до нуля, и, наоборот, невозможно снижение способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 до нуля с последующим устранением способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l.

Тем не менее, способ, основанный на независимом определении ЛБО и УО будем считать наиболее близким к предлагаемому. Легко видеть, что все укaзанные выше способы пригодны для управления движением только непосредственно по опорной траектории, а не по эквидистантной ей заданной траектории, т.е. решают частную задачу для случая нулевой заданной дистанции (l 0).

Из всего многообразия общеизвестных способов определения дальности до материальных объектов (радиотехнические, радиолокационные, лазерные и др.) в практике управления движением наземных ТС, в частности сельскохозяйственных агрегатов, известно только прямое измерение ЛБО от независимых (провода с током, рядки растений) и зависимых ОТ [1, гл.4] [3, гл.3] реализуемое контактными и бесконтактными датчиками, установленными на выносимых за габариты машины сложных механических конструкциях.

Достоверность информации, получаемой при таких измерениях низка, а пределы измерений (величина измеряемого ЛБО) на практике малы.

Известен способ [1, c.67] определения ОУ ТС, заключающийся в измерении расстояний от некоторых точек а и b (фиг.2) ТС, лежащих на прямой, параллельной его продольной оси (или совпадающей с ней), расстояние между которыми lab, до их мест на ОТ a" и b" и реализации зависимости

sinспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926

(5)

Способ не пригоден при использовании вынесенных вперед по ходу ТС НТ (a" и b", фиг. 2) целесообразность чего отмечена в [1, c.44] так как при этом треугольник abc становится косоугольным abc1, из всех элементов которого известна только одна сторона lab.

Известен способ получения сигнала, пропорционального сумме координат L и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 ТС, заключающийся в измерении суммарного курсового угла способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c (фиг.1) при сохранении постоянным расстояния r от места ТС на ЛП до ТНТ. Известны и реализующие его устройства, содержащие контактные электромеханические [1, c. 121-123] и бесконтактные сканирующие оптико-электронные датчики угла способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c пропорциональный которому сигнал и используется в качестве управляющего.

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

Угол способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c представляет собой простую аддитивную сумму углов способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 которая не дает никакого представления о величинах слагаемых или их соотношении (что отмечено в [1, c.46] "сигналы способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 неразделимы") и, следовательно, указанный способ не позволяет получить раздельно сигналы координат L и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926.

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

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

Указанная цель достигается тем, что в способе управления движением ТС, согласно которому получают раздельно сигналы расстояния от ТС до опорной траектории (сигнал текущей дистанции ТД) и углового отклонения ТС от ОТ, дополнительно формируют сигнал линейной координаты заданной траектории (сигнал заданной дистанции ЗД), вычитают сигнал ЗД из сигнала ТД, получают сигнал скорости поступательного движения ТС, умножают его на сигнал углового отклонения, суммируют разностный сигнал и сигнал произведения и воздействуют суммарным сигналом на исполнительный орган системы управления движением ТС.

Таким образом, управляющий сигнал, который может быть с учетом выражений (1) и (2) представлен в виде y C5(L-l)+C2V(t)способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t)=C6V(t)способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t)dt+C2V(t)способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t), (6)

а при V const в виде

y C6Vспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t)dt + C2Vспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926(t) (7)

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

Легко видеть, что предлагаемый способ пригоден для управления движением как по опорной траектории (заданная дистанция l 0), так и по эквидистантной ей (l способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 0).

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

Указанная цель достигается также и тем, что в дополнение к известному измерению курсового угла одной ТНТ производят измерение КУ второй, не совпадающей с первой ТНТ, формируют сигналы, пропорциональные заранее определенным (по конструкции датчика курсового угла и высоте его установки на ТС над поверхностью движения) расстояниям до ТНТ1 и ТНТ2, а обработку сигналов производят в соответствии с выражениями

L способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926

(8)

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261(2)- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926

(9) где способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 КУ первой (ТНТ1) и второй (ТНТ2) навигационных точек;

r1, r2 расстояния до первой и второй ТНТ, r1 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 r2.

Покажем справедливость выражений (8) и (9). Обратимся к фиг.3а,б, где D1, D2 датчики, Н высота установки датчиков, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 углы установки датчиков, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 величина, определяющая разность r2-r1, остальные обозначения прежние.

Отметим здесь же, что должно выполняться неравенство l < r1 < r2, причем r1 должно быть больше l на некоторую величину способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l1, превосходящую любое допустимое рассогласование способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926lmax и определяющую "зону захвата" (l способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l1, при этом способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l1 может быть и, как правило, больше l), в пределах которой может быть обнаружена ОТ и выработан сигнал для управления выходом на нее или ЗТ; при этом обеспечивается расположение ТНТ1 и ТНТ2впереди ТС, целесообразность чего уже отмечалась и следует из того, что, очевидно, нельзя вести ТС глядя, например, в сторону, а не вперед, причем тем дальше вперед, чем больше скорость ТС.

Для упрощения записи углы способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c будем считать малыми. Тогда

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т1= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 + способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926, откуда способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (10)

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926т2= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 + способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926, откуда способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (11)

Из (9) и (10) следует, что

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 или способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1-способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 Lспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (12)

и L способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926

Подставив (12) в (10) или (11) получим

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1(2)- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 или

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1(2)- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (13)

Разумеется, в формуле изобретения индексы "l" (способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2) могут быть опущены.

Проанализируем выражения (12) и (13) с точки зрения их технической реализации.

В качестве датчиков могут использоваться любые из упоминавшихся ранее, но наиболее перспективными авторы считают бесконтактные оптико-электронные датчики, вырабатывающие электрические сигналы, пропорциональные суммарному курсовому углу, получение разности которых пропорциональной способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2 никакой сложности не вызывает.

Рассмотрим выражение способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926, которое, используя фиг.3,б, запишем в виде

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 (14)

Величины Н, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 выбираются из соображения возможности обнаружения датчиками ОТ на поверхности движения, при этом учитывается, что чем больше способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 тем меньше отношение (14), определяющее чувствительность к рассогласованию способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 отношение приращения выходного сигнала к приращению вызвавшего его рассогласования L или способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 ( способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262= способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926).

Еще одно соображение по выбору способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 будет приведено ниже. С учетом (14) выражения (12) и (13) можно записать в виде

L способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926Hспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926f1(способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926) (15)

способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c1-способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926f2(способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926) (16a)

или способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2- способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926c2-способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926f3(способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926) (16б)

Пример реализующей соотношения (15)-(16,б) функциональной схемы приведен на фиг.4, где 7 задатчик сигналов H, f1( способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926) и f2( способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926) или f3( способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926) устройство, содержащее, например, три потенциометра, сигналы которых выставляются после установки датчиков на ТС, и блоки вычитания, перемножения и деления этих сигналов; 8, 9, 10 устройства перемножения сигналов; остальные обозначения те же, что и выше и общепринятые. Отметим еще, что предлагаемый способ, как это следует из выражений (8, 9; 12, 13; 15, 16) обеспечивает определение координат той точки ТС, в которой или над которой установлены датчики.

На фиг.5 приведена функциональная схема устройства, реализующего предлагаемый способ, описываемый выражением (6).

Здесь: lн заданная дистанция первой эквидистантной траектории или начальная координата неэквидистантной траектории; ls постоянный или меняющийся сигнал ЗД, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926ls сигнал ЛБО, L, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 сигналы ТД и УО, V сигнал скорости поступательного движения ТС, у управляющий сигнал, 11 задатчик сигнала ЗД, 12 множитель.

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

Если устройство (фиг.5) предназначено для управления движением по одной эквидистантной траектории, то задатчик сигнала 11 может содержать, например, потенциометр, сигнал которого выставляется перед началом движения пропорционально заданной дистанции. При этом в случае, например, необходимости объезда препятствия, водитель может брать управление на себя или вручную менять сигнал ЗД.

Если устройство предназначено для управления движением по ряду следующих друг за другом эквидистантных траекторий со сменой их в процессе движения в функции пройденного пути или по неэквивалентной, заранее заданной прямолинейной или криволинейной траектории, задатчик 11 содержит интегратор-датчик пути, на который подается сигнал V, потенциометр-задатчик начальной дистанции, блок хранения программы и блок изменения сигнала ЗД.

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

Предложенный способ управления предназначен для обеспечения эквидистантного движения той точки ТС, координаты которой определены по предложенному способу, т.е. точки, в которой или над которой установлены датчики. Следовательно, если должно быть обеспечено эквидистантное движение точки ТС, не совпадающей с указанной, например, точки l (фиг.6, где, кроме того, показаны: возможная точка d установки датчиков на буксировщике или одиночной машине, точка f эквидистантное движение которой должно быть обеспечено, например, при обратном проходе при челночном движении ТС, l1 расстояние между точками d и е, d и f, g возможная точка установки датчиков на буксируемом агрегате, остальные обозначения те же), тогда заданная дистанция l должна быть увеличена на величину l1. Действительно, как следует из фиг.6, ЛБО точки e Le L-l1 и после подстановки в первое слагаемое правой части выражения (6) получим [(L-l1)-l] L-(l+l1). В этом случае с помощью задатчика 11 (фиг. 5) в блок управления должен вводиться сигнал lse, соответствующий lнe l+l1. Сказанное справедливо для ТС одиночной машины или жестко связанного с ней агрегата, когда величина l1 может быть определена заранее, причем в последнем случае датчики могут быть установлены как на буксировщике, так и, например, в точке g (фиг.6) прицепа. В случае же не жесткой связи между буксировщиком и прицепом, когда величина l1 не является постоянной за счет возможного линейного смещения их относительно друг друга и, следовательно, не может быть учтена при задании сигнала lse, очевидно, что датчики следует устанавливать на прицепном агрегате.

Отметим еще, что если технические характеристики датчиков не позволяют при установке их на оси симметрии ТС (в точках d или g) одной их парой определять координаты при прямом и обратном проходах, то предлагаемый способ управления можетбыть реализован с использованием двух пар датчиков, расположенных по краям ТС (в точках е и f) и поочередно подключаемых к входу блока выработки координат (фиг.4).

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

Подводят ТС к началу ОТ и устанавливают таким образом, чтобы управляющий сигнал (отклонение стрелки индикатора) стал равен нулю после некоторых колебаний, свидетельствующих о том, что датчики "захватали" ОТ, что будет свидетельствовать о том, что ТС (его заданная точка) находится на заданном расстоянии l от 01 и что угловое отклонение отсутствует. Управляющие колеса ТС приводят в нейтральное положение, после чего можно начинать движение.

Пусть в процессе движения за счет возмущающих воздействий возникло отклонение управляющих колес и, начиная с некоторой точки h заданной траектории (фиг. 7) заданная точка ТС начала отклоняться от ЗТ с нарастающими УО и ЛБО начала двигаться по реальной 11. При этом будут выработаны сигналы УОспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 и ЛБО способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l и на индикатор поступит сумма сигналов 13 пропорционального способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l Vспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 и 14 пропорционального способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926Vспособ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926dt, являющаяся управляющим сигналом в автоматической СУ и пропорциональное которой отклонение стрелки индикатора у1 будет "управляющим сигналом" в описываемой "индикаторной" системе.

При появлении этого сигнала водитель начнет возвращать управляющие колеса сначала в нейтральное положение, а потом, чтобы уменьшить управляющий сигнал, разворачивать их в сторону, противоположную отклонению, вызванному возмущением. В результате этого УО начнет уменьшаться и к точке i (фиг.7) ЛП ТС придет с способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l > 0, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 0 и развернутыми управляющими колесами, что приведет к появлению и росту УО противоположного знака, сигнал которого будет вычитаться из сигнала способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l, в свою очередь, уменьшающегося за счет приближения заданной точки ТС к ЗТ.

Уменьшение управляющего сигнала, тенденция к которому может обозначиться еще до точки i (фиг.7) в зависимости от соотношения коэффициентов преобразования С1 и С2 (см. выражения 1,2) каналов способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l и способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l и которое является задачей водителя, приведет к тому, что последний вновь начнет возвращать управляющие колеса в нейтральное положение, в результате чего ТС подойдет к некоторой точке j ЛП с способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926=0, способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926l 0 и управляющими колесами, выведенными в нейтральное положение и будет двигаться дальше по ЗТ. Таким образом, большая величина управляющего сигнала в точках h и i и следовательно, высокий темп разворота управляющих колес на соответствующих им участках ЛП способствует минимизации времени (соответственно, и участка ЗТ) устранения рассогласования, выход за ЗТ с одновременным выводом управляющих колес в нейтральное положение исключает динамическую ошибку (рыскание ТС относительно ЗТ), а пропорциональность управляющего сигнала интегралу сигнала УО устраняет и статическую ошибку (делает систему астатической). Очевидно, что действия водителя ТС, оснащенного такой автоматизированной СУ ничем не отличаются от действий водителя, ориентирующегося по внешним ориентирам (полосе дорожной разметки и др.) и выполняющего маневр "переставка", поэтому можно надеяться, что для опытного водителя переход от "визуального" управления к управлению "по индикатору" не будет слишком трудным. Использование таких "индикаторных" СУ целесообразно, когда в силу каких-то причин (например, значительное удаление ЗТ от ОТ при управлении движением широкозахватных посевных агрегатов) визуальная ориентировка не обеспечивает достаточной точности управления и невозможно (или нецелесообразно) оснащать ТС рулевой машиной, т.е. превращать СУ в автоматическую.

Предложенный способ определения координат ТС благодаря наличию двух датчиков использующих не совпадающие ТНТ, делает возможной реализацию известного [1, c.117] способа сглаживания случайных искривлений ОТ и фильтрации помех (например, комьев земли и т.п.), маскирующих отдельные участки ОТ. Для этого необходимо лишь незначительное усложнение блока выработки координат и выбор способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 2032926 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329262 способ управления эквидистантным движением транспортного   средства и способ определения углового и линейно-бокового   отклонения транспортного средства от опорной траектории, патент № 20329261 (фиг.3,б), обеспечивающий достаточное расстояние между текущими навигационными точками.

Класс G05D1/02 управление местоположением или курсом в системах двух координат

способ управления скоростью, положением в пространстве и направлением движения транспортного средства, реализующего схему бортового поворота и снабженнного независимыми электроприводами колес -  патент 2517284 (27.05.2014)
мобильное роботизированное устройство, имеющее датчик столкновений -  патент 2501678 (20.12.2013)
устройство, содержащее, по меньшей мере, тело и амортизатор, и робот-пылесос, содержащий такое устройство -  патент 2486571 (27.06.2013)
устройство для определения маршрута транспортного средства -  патент 2467374 (20.11.2012)
авторулевой судна -  патент 2465170 (27.10.2012)
способ координированного маневрирования судна -  патент 2429161 (20.09.2011)
способ управления системой сельхозмашин и автоматическая система управления -  патент 2424642 (27.07.2011)
устройство управления автомобилем -  патент 2392143 (20.06.2010)
дистанционно управляемое колесное транспортное средство -  патент 2388639 (10.05.2010)
способ и устройство для определения ширины коридора безопасного маневрирования летательного аппарата и способ и система обеспечения безопасности автоматического полета летательного аппарата на малой высоте -  патент 2361259 (10.07.2009)
Наверх