
2065
.pdfгде V - скорость машины.
Вертикальные координаты крайних левой и правой точек режущей кромки РО определяются как
YРОЛ |
(t) YРО |
(t) YO X |
0 |
YO Z |
; |
(2.9) |
|
|
0 |
0 |
0 |
|
|
YРОП |
(t) YРО |
(t) YO X |
0 |
YO Z |
, |
(2.10) |
|
|
0 |
0 |
0 |
|
где YO0Z0 - вертикальное приращение вертикальной координаты РО,
вызванное перекосом автогрейдера вокруг оси O0Z0 на угол α при наезде на неровность грунта, YO0Х0 - вертикальное приращение
вертикальной координаты РО, вызванное перекосом автогрейдера вокруг оси O0Х0 на угол γ при наезде на неровность грунта.
|
|
|
|
|
Y |
|
|
|
|
|
|
L3 |
cos tg ; |
(2.11) |
|||||||||||||||||||
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||
|
|
|
|
|
O Z |
0 |
2 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||
|
|
|
0 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||
|
|
|
|
|
Y |
|
|
|
|
|
L3 |
sin tg ; |
|
|
|
|
|
|
|
(2.12) |
|||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||
|
|
|
|
|
О Х |
|
0 |
2 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||
|
|
|
0 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||
|
|
|
|
|
tg |
YБП (t) YБЛ (t) |
; |
|
|
|
|
|
|
|
(2.13) |
||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
L3 |
|
|
|
|
|
|
|
|
||||||||
|
|
|
|
|
tg |
YБ (t) Y1(t) |
, |
|
|
|
|
|
|
|
|
|
(2.14) |
||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
L |
|
|
|
|
|
|
|
|
||||||
где L3 - ширина колеи машины, φ – угол захвата РО. |
|
||||||||||||||||||||||||||||||||
Подставив выражения (2.11) - (2.14) в (2.9) - (2.10), получим |
|
||||||||||||||||||||||||||||||||
Y |
(t) Y |
РО |
(t) |
YБП (t) YБЛ (t) |
sin |
|
L3 |
|
cos |
YБ (t) Y1(t) |
; |
(2.15) |
|||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||
РОЛ |
|
|
|
|
2 |
|
|
|
|
|
|
|
2 |
|
|
|
|
L |
|
||||||||||||||
Y |
(t) Y |
РО |
(t) |
YБП (t) YБЛ (t) |
sin |
L3 |
|
cos |
YБ (t) Y1(t) |
. |
(2.16) |
||||||||||||||||||||||
|
|
|
|
|
|
|
|||||||||||||||||||||||||||
РОП |
|
|
|
|
2 |
|
|
|
|
|
|
|
2 |
|
|
|
|
L |
|
||||||||||||||
Приняв для упрощения записи: |
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||
|
|
|
|
|
|
|
K1 |
sin |
; |
|
|
|
|
|
|
|
|
(2.17) |
|||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2 |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||
|
|
|
|
|
K2 |
L3 |
сos |
, |
|
|
|
|
|
|
|
(2.18) |
|||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
2 L |
|
|
|
|
|
|
|
|
||||||||
уравнения (2.15) и (2.16) запишем в виде: |
|
|
|
|
|
|
|
|
|||||||||||||||||||||||||
YРОЛ (t) YРО (t) K1 (YБП (t) YБЛ (t)) K2 (YБ (t) Y1(t)); |
(2.19) |
||||||||||||||||||||||||||||||||
|
YРОП (t) YРО (t) K1 (YБП (t) YБЛ (t)) K2 (YБ (t) Y1(t)). |
(2.20) |
|||||||||||||||||||||||||||||||
Тогда угол перекоса отвала РО в момент времени t: |
|
||||||||||||||||||||||||||||||||
|
|
|
РО tg РО |
|
YРОП (t) YРОЛ (t) |
sin . |
(2.21) |
||||||||||||||||||||||||||
|
|
|
|
||||||||||||||||||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
L3 |
|
|
|
|
|
|
|
|
|||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
40 |
|
|
|
|
|
|
|
|
|
|
|
|
|
Для положения отвала, изображенного на рис. 2.2, поперечный профиль обрабатываемой поверхности грунта сформирован лишь на половине пути, пройденного стороной отвала максимально приближенной к передней оси автогрейдера. С другой стороны отвала профиль в момент времени t пока не сформирован, так как отвал еще не дошел до этого места.
С учетом сказанного можно записать:
tg ПРО |
(t ) |
YРОП (t ) YРОЛ (t) |
, при 90 ; |
(2.22) |
||||||||
|
|
|
|
|
|
|
|
|||||
|
|
|
|
L3 |
|
|||||||
tg ПРО |
(t ) |
YРОЛ (t ) YРОП (t) |
, при 90 ; |
(2.23) |
||||||||
|
|
|
|
|
|
|
||||||
|
|
|
|
L3 |
|
|||||||
|
|
|
YПРО (t ) YРО (t ); |
(2.24) |
||||||||
|
|
|
|
L3 |
|
сos |
|
|
. |
(2.25) |
||
|
|
|
|
|
||||||||
|
|
|
|
|
||||||||
|
|
|
|
|
|
|
|
|||||
|
|
|
|
V |
|
При движении автогрейдер колесами балансирной тележки обычно движется по обработанному грунту. Поэтому определим вертикальные координаты задних колес [101].
Y2Л (t) YРОЛ (t Л ); |
(2.26) |
Y2П (t) YРОП (t П ); |
(2.27) |
Y3Л (t) Y2Л (t Б ); |
(2.28) |
Y3П (t) Y2П (t Б ), |
(2.29) |
где Л , П - время, необходимое для прохождения машиной расстояния от режущей кромки РО до передних колес балансирной тележки по левой и правой колее.
Л |
|
L2 |
(L3 |
/ 2) сos LБ1 |
; |
(2.30) |
||
|
|
|
||||||
|
|
|
|
|
V |
|
||
П |
|
L2 |
(L3 |
/ 2) сos LБ1 |
. |
(2.31) |
||
|
|
|
||||||
|
|
|
|
|
V |
|
Динамические характеристики ходового оборудования описаны с помощью аппарата передаточных функций колебательным звеном второго порядка, входом которого является кинематическое воздействие на элементы ходового оборудования.
41

|
|
Передняя ось |
|
|
e-tПp |
|
|
|
|
|
|
|
|
K2=f( ) DYOZ |
|
|
|
||
|
|
Y1П |
|
Y1 |
|
|
|
|
|
|
|
WK |
1/ 2 |
|
|
|
|
|
|
|
|
Y1Л |
1-K |
|
|
|
|
|
|
|
|
|
|
|
|
e-tp |
РО |
|
|
|
|
WK |
|
|
|
|
РО |
||
|
|
|
|
|
|
|
YРОП |
|
tgg |
|
|
|
|
|
|
|
1/ L3 |
||
|
|
|
Балансирная тележка |
|
YРО |
YРОЛ |
|||
Y2П |
|
|
|
|
|
||||
WK |
1-KББ |
|
|
|
|
|
|
YРО |
|
|
|
|
|
|
|
|
|||
|
e-tБp |
Y3П |
KББ |
YБП |
Б |
|
|
|
|
|
WK |
|
|
|
|
|
|||
|
|
|
|
|
Y |
|
|
|
|
|
e-tБp |
Y3Л |
KББ |
YБЛ |
1/ 2 |
K |
|
|
|
|
WK |
|
|
DYOX |
|
|
|
||
|
|
|
|
|
|
|
|
|
|
Y2Л |
WK |
1-KББ |
|
|
|
K1=f( ) |
|
|
|
|
|
|
e-tЛp |
|
|
|
|||
|
|
|
|
|
|
|
|
|
|
|
|
|
Рис. 2.3. Структурная схема математической модели автогрейдера |
|
|
||||
|
|
|
|
|
42 |
|
|
|
|

H1
Время моделирования
A2
Начало
B2
Ввод исходных данных
C2 |
Расчет
Б, Л, П, ,K,KББ
D2
Цикл для t=0 с шагом t
E2
Расчет
Y2П,Y2Л,Y3П,Y3Л,YБП, YБЛ,YБ,Y1, YOZ, YOX
F2
Расчет
YРО,YРОП,YРОЛ, РО
G2
B3
Значения параметров
L,L1,L3,LБ,LБ1, ,
V,K,T1,T2 ,Y1П,Y1Л
Запись файла данных
H3
H2Конец Нет
пути? t=t+ t
Да
I2
Конец
Геометрические параметры машины, скорость движения, параметрыдвижителя, вертикальные координаты неровностей под передними колесами
Координатырежущей кромки отвала
Рис. 2.4. Блок-схема алгоритма реализации математической модели автогрейдера
43
Уравнение звена с использованием аппарата передаточных функций [101]:
WК (p) |
|
K |
|
|
, |
(2.32) |
T 2 p2 |
T |
p 1 |
||||
1 |
2 |
|
|
|
|
где T1 и Т2 - постоянные времени; K – коэффициент передачи. На основании уравнений (2.1) - (2.32) построена структурная схема математической модели автогрейдера, представленная на рис. 2.3.
Блок-схема алгоритма реализации модели представлена на рис. 2.4.
2.3. Математическая модель системы управления рабочим органом автогрейдера
Многообразие функций оператора, возмущения со стороны микрорельефа обрабатываемой поверхности, передающиеся через ходовое оборудование и раму автогрейдера на РО, реакция грунта непосредственно на РО, приводящие к изменению положения РО автогрейдера, высокие требования к точности земляного сооружения являются причинами не позволяющих обеспечивать геометрические параметры формируемой поверхности, требуемые СНиП. В связи с этим появился целый ряд СУ, исключающих оператора из контура управления положением РО.
Общим вопросам исследования СУ землеройных машин и их математическому моделированию посвящены работы Т.В.Алексеевой [2, 57], В.Ф.Амельченко [3], В.А.Байкалова [6], А.Ф.Бакалова [7], В.И.Баловнева [12,13], Б.Д.Кононыхина [70], Э.Н.Кузина [73], Е.Ф.Малиновского [76], В.А. Палеева [85], В.Н. Тарасова [100], В.В.Титенко [101], В.С.Щербакова [2, 110] и др.
Предлагается реализовать алгоритм одновременного управления обоими гидроцилиндрами, путём установки на отвал двух лазерных датчиков высотного положения РО. Управление отвалом будет происходить левым и правым гидроцилиндром.
СУ РО в пространстве состоит из следующих элементов:
-задатчика проектной плоскости (лазерного нивелира);
-датчиков вертикальной координаты (лазерных приемников);
-элементов сравнения;
-пороговых элементов;
-исполнительного электрогидропривода.
44
В данной работе в качестве задающих параметров приняты высота средней точки режущей кромки отвала YPOЗ и угол поперечного наклона отвала γРОЗ. В качестве информационных параметров – вертикальные координаты правого и левого краев отвала YРОП и YРОЛ. После установки на задатчиках требуемых геометрических параметров дорожного полотна YРОЗ, γРОЗ СУ РО устанавливает отвал в требуемое положение с помощью правого и левого гидроцилиндров. За счёт неровностей микрорельефа под колёсами и силы реакции разрабатываемого грунта на отвал возникают неуправляемые перемещения базовой машины как в продольной, так и в поперечной плоскостях, что приводит к изменению положения РО. Лазерные приёмники высотного положения, установленные на краях отвала, считывают текущие вертикальные координаты. Элементы сравнения вычисляют рассогласование между текущими и заданными значениями параметров, и как только эта величина становится больше ширины зоны нечувствительности порогового элемента, подаётся сигнал управления на золотник соответствующего электрогидрораспределителя, в результате чего начинает перемещаться шток соответствующего гидроцилиндра, поднимая или опуская свой край отвала, до тех пор, пока разность сигналов датчика и задатчика не станет меньше ширины зоны нечувствительности, т.е. отвал вернётся в заданное положение.
Лазерный приёмник вертикальной координаты представляет собой безинерционное звено. Он преобразует перемещение своего чувствительного элемента в электрический сигнал по пропорциональному закону [77].
WД (p) KД , |
(2.33) |
где KД – коэффициент пропорциональности преобразования. Пороговый элемент представляет собой электронное реле с
регулируемой зоной нечувствительности (рис. 2.5). Поскольку быстродействие электронных схем является высоким в сравнении с другими элементами, пороговый элемент описан как безинерционное реле.
|
iзол ,при I |
с; |
|
|
i |
|
|
I c; |
(2.34) |
зол 0,при с |
||||
|
|
,при I |
с; |
|
|
iзол |
|
||
|
|
45 |
|
|

где iзол – ток, подаваемый на электрогидрораспределитель; I – значение обработанного сигнала рассогласования для правого и левого параметра управления, 2с – ширина зоны нечувствительности порогового элемента СУ.
iзол
+iзол
-с |
с |
I |
|
||
|
-iзол |
|
Рис. 2.5. Статическая характеристика порогового элемента
Пороговыми значениями для каждого контура управления
являются |
допустимые |
отклонения значений соответствующих |
||||
параметров. |
|
|
|
|
|
|
Одной из важнейших составляющих сложной динамической |
||||||
модели |
формирования |
земляного |
полотна |
является |
||
электрогидравлический |
привод |
РО, |
осуществляющий |
его |
перемещение относительно базовой машины и, соответственно, изменяющий параметры формируемого земляного полотна. Решение задач анализа и синтеза гидропривода невозможно осуществлять без его математической модели [110].
Существует множество схем гидроприводов, но все они представляют собой совокупность малого количества функциональных элементов гидроаппаратуры: насос, гидромотор, гидроцилиндр, гидролиния, дроссель, клапаны и др. Поэтому гидропривод автогрейдера, без количественного учёта гидроэлементов, можно представить в виде блок-схемы (рис. 2.6).
В настоящее время можно выделить два направления математического описания гидроприводов.
Первое направление заключается в представлении гидроэлементов в виде передаточных функций типовых динамических звеньев известных из теории автоматического управления. Представление элементов гидропривода в виде передаточных функций основывается на экспериментальных
46

исследованиях, при этом реальный переходный процесс элементов гидропривода аппроксимируется с некоторой точностью передаточными функциями.
|
|
|
Pн |
|
iр |
|
Pр |
|
Fц |
||||||||||
eн |
|
|
|
|
|
|
|
|
|
|
|
|
|
||||||
|
|
Qн |
|
|
|
Qл |
|
|
|
Qр |
|
|
|
Qц |
|
|
υц |
||
Гидро- |
Гидро- |
Распре- |
Гидро- |
Гидро- |
|||||||||||||||
ωн |
|||||||||||||||||||
насос |
|
линия |
|
делител |
|
линия |
|
цилинд |
|
||||||||||
|
|
|
|
|
|
||||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
Mс.г |
|
Pл |
|
Pл |
|
|
|
|
|
Pц |
|
Рис. 2.6. Блок-схема гидропривода рабочего органа автогрейдера
Точность моделирования гидропривода при этом способе определяется точностью аппроксимации переходных процессов и точностью замеров, проводимых в ходе эксперимента. При этом способе достаточно сложно учесть большое количество параметров влияющих на работу гидропривода, что ведет к упрощению математической модели гидропривода в целом.
Второе направление заключается в том, что для каждого из элементов, входящих в гидропривод, составляется своя математическая модель, представляющая собой дифференциальные уравнения, а затем находится общее дифференциальное уравнение, описывающее гидропривод машины в целом.
Данный способ обладает высокой точностью описания динамических процессов происходящих в гидроприводе и при наличии мощных вычислительных систем легко реализуется на ЭВМ.
Однако, для решения задач динамики гидрофицированной машины в целом, когда наибольший интерес представляет движение выходного звена исполнительного электрогидропривода при подаче на вход управляющего воздействия, то есть "макродинамика" гидропривода, его математическое описание может быть значительно упрощено. При этом не будут рассматриваться процессы, связанные с работой отдельных гидроэлементов.
При описании электрогидропривода в качестве входного воздействия принята выходная координата порогового элемента, в качестве выходной координаты - перемещение штока гидроцилиндра.
47
Так как объемный гидропривод обладает такими общими свойствами, как время запаздывания и постоянная скорость перемещения штоков исполнительных гидроцилиндров в установившемся режиме, переходные процессы разгона и торможения штока гидроцилиндра, то можно выделить следующие характерные стадии переходного процесса:
-чистое запаздывание τг в течение которого шток находится в покое после включения, распределителя;
-стадию разгона Tр, в течение которой шток разгоняется до номинальной скорости;
-стадию установившегося движения.
Выделенным стадиям можно поставить в соответствие три последовательно соединенных звена - звено чистого запаздывания, апериодическое звено первого порядка и интегрирующее звено.
Математическое описание звена чистого запаздывания имеет вид
[77]:
Qг(t) = Rг(t-τг), |
(2.35) |
где Rг, Qг – соответственно входной и выходной сигналы звена |
|
чистого запаздывания. |
|
Передаточная функция такого звена определяется по |
|
преобразованию Лапласа, и имеет вид [110,112]: |
|
Wз (р) e p г , |
(2.36) |
Свойства апериодического звена первого порядка определяются постоянной времени Tр, характеризующей его инерционность, и коэффициентом передачи Кр.
С учетом того, что Кр = 1, передаточная функция имеет вид:
Wp |
(p) |
1 |
|
. |
(2.37) |
|
|
||||
|
Tp p |
1 |
|
Передаточная функция интегрирующего звена:
Wy |
(p) |
Kш |
, |
(2.38) |
|
||||
|
|
p |
|
где Kш - коэффициент, определяющий скорость штока гидроцилиндра в установившемся режиме.
Общую передаточную функцию гидропривода можно записать:
WГП |
(р) |
K |
ш |
e |
p г |
|
|
|
|
(2.39) |
|||
|
|
|
|
|||
|
|
p(Tp p 1) |
Численные значения коэффициентов зависят от конструктивных параметров элементов гидропривода.
48

Оператор выставляет на задатчике требуемые угол поперечного уклона γРОЗ и вертикальную координату дорожного полотна YРОЗ, а датчики измеряют высотные координаты краёв отвала YРОП, YРОЛ. Необходимо параметры γРОЗ и YРОЗ преобразовать в YРОПЗ и YРОЛЗ, и на элементах сравнения вычислять отклонения краёв отвала.
Изменение положения края отвала (места крепления штока ГЦ к отвалу) YРОПЗ, YРОЛЗ определяется суммой изменения высотного положения центральной точки отвала YРОЗ и изменения высотного положения крайней точки отвала за счёт угла перекоса отвала γРОЗ в поперечной плоскости tgγРОЗ∙L3/2 (рис.2.7):
YРОПЗ |
YРОЗ |
tg РОЗ |
|
L3 |
(2.40) |
||
|
|
||||||
|
|
|
2 |
|
|
||
YРОЛЗ |
YРОЗ |
tg РОЗ |
|
L3 |
|
(2.41) |
|
|
|
||||||
|
|
|
2 |
|
|
Заданные координаты сравниваются с полученными от датчиков и на электрогидропривод идёт сигнал рассогласования:
П |
YРОПЗ |
YРОП |
(2.42) |
Л |
YРОЛЗ |
YРОЛ |
(2.43) |
Структурная схема математической модели СУ РО автогрейдера представлена на рис. 2.8. Блок - схема алгоритма реализации математической модели СУ РО автогрейдера представлена на рис. 2.9.
L3
YРОПЗ
РОЗ
YРОЗ
YРОЛЗ
Рис. 2.7. Схема преобразования γРОЗ и YРОЗ в YРОПЗ и YРОЛЗ
49