|
Корректировка интеграла ДУС магнитометром |
|
|
|
Jun 13 2012, 14:15
|
Частый гость
 
Группа: Участник
Сообщений: 78
Регистрация: 5-07-11
Пользователь №: 66 068

|
Датчик угловых скоростей. Его еще МЕМС гироскопом называют. Интегрирование сигнала ДУС по трем осям дает угловое положение объета - курс, крен, тангаж. Да вот беда - ошибка интегрирования накапливается. И хотя наше устройство лежит на столе, как мы видим глазом, все математические данные говорят о том, что оно медленно крутится. Магнитное поле Земли относительно статично, вращение устройства приводит к изменениям проекций вектора магнитного поля на оси, из которых можно вычислить те же крен, тангаж и курс, но уже без ошибки интегрирования. Но и тут не все так просто. Вот я и решил спросить
|
|
|
|
|
Jun 15 2012, 06:21
|
Частый гость
 
Группа: Участник
Сообщений: 78
Регистрация: 5-07-11
Пользователь №: 66 068

|
Принципы - да, но не совсем понятно, как их реализовывать на практике. Магнитометр и ДУС показывают, мягко говоря, не совсем одно и то же. Когда я вращаю устройство вокруг оси чувствительности ДУС (допустим, Х, т.е. вращение в плоскости OYZ), его интеграл дает угол поворота. Ровно на тот же угол поворачивается как сам вектор магнитного поля Земли (имеется ввиду в системе отсчета устройства), так и его проекция на плоскость OYZ. Но эта проекция изменяется и при вращении в других плоскостях. С ДУС еще одно НО: если вращать его по оси, которая не совпадает с осью чувствительности, он показывает меньшую угловую скорость (видимо, проекцию полного вектора угловой скорости на свою ось). В этом случае, например, я совершил полный оборот и положил устройство на место, а интеграл ДУС говорит, что поворот совершен, например, на 250 или сколько там еще градусов вместо 360. Может быть, дело в том, что мне не хватает данных - вы только не смейтесь, но у меня пока один (одноосевой) ДУС, остальные заказаны, но не прибыли еще. Известно, что zero-rate level у ДУС плавает, что может дать нам при полностью неподвижном устройстве уход угла поворота в бесконечность ос временем. Его изменения я постоянно отслеживаю и вычитаю, что избавляет нас от данного явления, но остается еще вот что: при вращениях я не могу его отслеживать. Получается: повернул, например, и вернул на место. Выход ДУС показал сначала положительную, затем отрицательную угловую скорости. Суммы этих отсчетов (положительных и отрицательных, т.е. интегралы) не равны, а это приводит к тому, что по математике устройство не вернулось в прежнее угловое положение. Образовалась ступенька, которых со временем также может набежать очень много, что даст большую ошибку. Вот ее я и хотел корректировать магнитометром. Предполагая, что магнитное поле Земли - достаточно медленно меняющийся параметр по сравнению с маневрами устройства. Но с математикой пока разобраться не могу. Конечно, вариант сделать алгоритм на логике, т.е. если там по такой-то си поменялось, а по такой-то нет, то этот интеграл ДУС скорректировать на столько-то. Но это очень ненадежно.
|
|
|
|
1 чел. читают эту тему (гостей: 1, скрытых пользователей: 0)
Пользователей: 0
|
|
|