Попробую, но боюсь, что в пару слов не уложусь. :)
Сначала кратко поясню свое понимание калибровки акселерометров, а после как это можно применить к магнитометрам (как я понял).
Когда акселерометр лежит на горизонтальной поверхности мы знаем, что показания должны быть только по одной оси и значение нам известно. Но реально акселерометр будет показывать по остальным осям не нули, т.к. имеются смещения нуля и возможно оси акселерометра не совпадают с осями объекта. Путем поворота объекта с акселерометром на разные грани, мы получаем 6 измеренных векторов и 6 векторов, которые должны быть. Далее при помощи линейной алгебры мы находим матрицу, которая позволяет путем умножения показаний акселерометра, находящегося на объекте, лежащем на горизонтальной поверхности (к примеру), получить значения ускорения такие, каковыми они должны быть. Таким образом мы рассчитали матрицу, которая убирает «перекосы» осей координат (производит поворот), убирает смещения нуля (производит сдвиг (для этого у нас матрица размерностью 4х4)) и производит масштабирование (лежащий на плоскости объект будет измерять силу реакции опоры, равную ускорению свободного падения, примерно 9.81 м/с^2). Надеюсь правильно понял?
Теперь как этот же алгоритм можно применить к калибровки магнитометра? Для этого нужно знать направление вектора магнитного поля Земли. Далее поочередно ориентируя на это направление разные оси ОБЪЕКТА разными направлениями мы так же получаем 6 векторов измерений, а 6 значений, которые должны быть — мы знаем. Далее все то же самое. При помощи линейной алгебры находим калибровочную матрицу. Вот так я понял Ваши предложения использовать методику, описанную в статье применительно к магнитометрам. Я ошибся? (без сарказма)
Если таким образом калибровать магнитометр, то сначала необходимо найти направление вектора магнитного поля Земли. Идея в том, чтоб вращая магнитометр найти положение, при котором по двум осям будут нули, тогда оставшаяся ось указывает направление вектора магнитного поля. Но как направлена ось магнитометра по отношению к объекту? Или даже по отношению к корпусу микросхемы? Нет гарантии, что линия, вдоль грани микросхемы однозначно соответствует оси чувствительности магнитометра.
Кстати, я предполагал, что после нахождения таким образом «направления», фиксировалось положение объекта и считалось, что он направлен по вектору магнитного поля. В дальнейшем осуществлялось изменение положения объекта (для набора 6 векторов измерений) относительно этого фиксированного положения. Это были мои домыслы. А как делали Вы?
Методика (Appendix C) действительно громоздкая, но она позволяет избежать необходимости определения вектора магнитного поля, которое всегда определяется с ошибкой. Никому не навязываю использовать только ее. Уверен, что существуют и другие методики (проще, сложнее, точнее, грубее). Каждый для себя выбирает ту, которая больше удовлетворяет его задачам.
Размышлял над Вашим способом калибровки магнитометра путем предварительного нахождения направления вектора магнитного поля.
Перед калибровкой компаса, понятное дело, надо сначала найти направление, а куда, собственно, магнитное поле направлено. Делал это так. Ориентировал плату руками так, чтобы показания по двум осям из трёх были нулевые.
Этот метод плох тем, что располагая так датчик вы совместите ось датчика с направлением на вектор, а для устранения перекосов необходимо совмещать ось объекта. Если есть возможность замерить углы, задающие направление вектора магнитного поля, то можно будет откалибровать, путем учета этого направления в математике. Но боюсь, что точность измерения этих углов будет крайне мала, что неизбежно повлияет на точность калибровки. Все же метод, описанный в документе, как мне кажется, более удобен, точен и прост.
По-моему, нигде выше по тексту не утверждается обратного.
Может неправ, но мне показалось, что…
Я ж, когда калибрую акселерометр, во-первых, неизбежно компас тоже ориентирую (они ж в одном корпусе). Ну и в принципе могу одновременно его калибровать — разницы нет. Просто надобности в компасе не было.
В обоих (акселерометр/компас) случаях просто вычисляется матрица перехода из внутренней системы координат акселерометра/компаса в систему координат ящика, в котором оный установлен. Нормировкака осей и вычисление сдвигов автоматом происходит при вычислении матрицы перехода. Нет?
как раз и была попытка откалибровать все одним заходом.
Может быть мы по разному понимаем слово калибровка? Под калибровкой я понимаю как раз совмещение осей датчика и объекта, а также масштабирование и устранение нулей.
а что заставляет думать, что я этот документ не читал?
Абсолютно ничего. Я и не думал. Просто как мне кажется, в этом документе хорошо расписано, как проводить калибровки. Способ найти направление вектора магнитной индукции, а после проводить калибровку так же, как и акселерометров — лично мне кажется не очень удобным. Результат сильно зависит от точности нахождения этого направления и возможности его поддержания неизменным (чтоб можно было переворачивать объект). Хотя и способ вращения вокруг осей объекта (метод описанный в документы к прибору) тоже не очень удобен.
Я был сильно удивлён тем фактом, что у меня дома магнитное поле направлено под углом градусов эдак 50 к горизонтали. Это вообще нормально?
Очень сильно улыбнуло. :)
В том-то и дело, что направление вектора магнитной индукции зависит от географического местоположения. Посмотрите документ, на который есть ссылка комментариях выше. Там расписана методика калибровки магнитометра. Причем там еще используется метод наименьших квадратов (как впрочем и при калибровке акселерометра).
Что касается самой матрицы калибровки. Она по сути состоит из трех матриц.
Одна матрица служит для поворота осей измерения датчика к осям объекта (немного грубо, но смысл думаю понятен). При умножении единичного вектора на эту матрицу длина вектора не изменяется, т.е. остается единичной. Происходит только поворот этого вектора.
Вторая матрица убирает смещения нуля или с точки зрения математики осуществляет сдвиг системы координат.
Ну и третья матрица служит для масштабирования коэффициентов передачи по каждому из направлений. В идеале это должна быть единичная матрица (по главной диагонали — 1, а остальные элементы — 0). Но после калибровки элементы главной диагонали будут иными.
Так вот, если все эти три матрицы перемножить, то получится необходимая нам матрица, на которую необходимо умножать измерения датчиков.
В одном из комментариев выше я говорил, что после калибровки акселерометра только часть полученной матрицы можно использовать для магнитометров, для поворота осей датчика. Устранить нули и провести масштабирование измерений магнитометра калибровкой одного только акселерометра не получится. Но пообщавшись сегодня с одним специалистом выяснилось следующее. Даже в этом датчике направление осей магнитометра и акселерометра не совпадают. К примеру оси Z у датчиков направлены в разные стороны. Кроме того специалист мне подсказал, что нет гарантии, что оси акселерометра и магнитометра вообще соосны, вот почему и проводятся калибровки для этих датчик.
Как мне кажется матрицу, полученную для калибровки акселерометров, для магнитометров можно использовать только для устранения несоответствия осей датчика и объекта. Масштабировать оси магнитометра и убрать смещение нуля не получится.
Скорее всего, если во всём тексте заменить слово «акселерометр» на слово «компас», то будет работать не менее правильно.
C компасом не совсем все просто. Его просто так «набок» не положить. Его калибровка проводится в два этапа. Сначала калибруют масштабный коэффициент, чтоб он был одинаков по всем трем направлениям, а уже потом «устраняют» перекосы осей датчика и осей объекта.
В статье предлагается сделать определение матрицы с использованием одного замера в каждом из положений, но лучше использовать несколько замеров в каждом положении. Это позволит точнее определить матрицу, т.к. измерения всех датчиков «шумят».
В качестве информации предлагаю посмотреть документ Using LSM303DLH for a tilt compensated electronic compass. В нем достаточно подробно расписана методика калибровки акселерометра и магнитометра, ну разве что на английском. Методика позволяет провести масштабирование коэффициентов по всем осям, убрать смещения нуля и перекосы осей датчиков и объекта. Лично я использовал эту методику для своих задач — работает!
Я совсем недавно сделал себе подобный «девайс». Правда все делал из оргстекла (или акрилата, т.к. не знаю точно). Думаю интересно, сколько времени занимает травление. Я провел одно боевое испытание. Травил в подержанном хлорном железе, правда подогрел его в микроволновке градусов, так думаю, до 50-60. В плате сделал маленькое отверстие и при помощи капроновой нити опускал в ванну и подвешивал. Травление заняло менее 10 минут (через 5 минут часть меди уже слезла). Для сравнения подобный раствор (подогретый и с ручным перемешиванием) травил минут 15-20. В чем вижу плюс подобной ванны? Во первых обе стороны травятся одинаково быстро. Раньше нужно было травить по очереди. Во вторых раствора нужно меньше, т.к. толщина ванны небольшая. Думал, что при использовании хлорного железа не будет видно, как протекает процесс травления, но все таки видно. Не очень хорошо, но все же видно. Хотя думаю, что можно будет попробовать использовать какой-нибудь прозрачный раствор.Как будет некоторая статистика по использованию — отпишусь.
На самом деле интегрирование производится в п.1, когда из угл.скорости (производной угла) получается угол. А в п.2 производится поворот приращений углов из связанной системы координат (ССК), к приращениям в инерциальной системе координат (ИСК), которая в нашем случае связана с поверхностью Земли (с горизонтом, если хотите).
Но на самом деле так делать можно только при небольших углах и то результат будет приближенный. Реально же необходимо интегрировать кинематические уравнения углового движения (например в направляющих косинусах). В результате интегрирования мы получаем угловое положение ЛА относительно ИСК, имея угловые скорости ЛА, в проекциях на ССК.
Нельзя просто проинтегрировать показания датчиков угловой скорости (которые часто называют гироскопами, что не совсем верно), закрепленных на корпусе ЛА. Полученные таким образом углы не будут отражать угловое положение ЛА в ИСК.
думаю, что это вряд ли. Сделал простую прикидку. Если взять акселерометр, с диапазоном измерения +/-2g и предположим, что преобразователь у нас 16-ти разрядный, то 1 разряд будет равен примерно 0,000006 g. Согласно ГОСТу ПЗ-90 (Параметры Земли) такое изменение ускорения свободного падения будет наблюдаться при подъеме на высоту 200 метров (если на экваторе). Обычно показания акселерометров «шумят» 2-4 разряда, что будет соответствует разбросу высот 400-800 метров. Думаю, что не многие любительские коптеры летают на бОльших высотах, поэтому изменением ускорения свободного падения с высотой можно пренебречь (во всяком случае на первых порах).
Добрый день, господа!
Позвольте мне немного подправить понимание того, что измеряет акселерометр. Согласно определению акселерометр — прибор, измеряющий проекцию кажущегося ускорения. Кажущееся ускорение — это ускорение, возникающее под действием негравитационных сил, т.е. акселерометр не может измерять ускорение свободного падения (g). Тогда возникает, что же измеряет акселерометр, находящийся в покое на Земле? А измеряет он ускорение от силы реакции опоры (согласно 3-ему закону Ньютона). Если внимательно посмотреть в какую сторону направленна сила, ускорение от которой измеряет покоящийся акселерометр, то она направлена вверх, а не вниз, как сила тяжести.
Летательный аппарат (ЛА), который находится в состоянии свободного падения будет измерять только ускорение, возникшее от силы аэродинамического сопротивления воздуха (т.к. реакции опоры не будет), которое очень мало и я не уверен, что MEMS акселерометр измерит его (хотя можно и оценить). Если ЛА «зависат» в воздухе, т.е. сила тяги двигателей уравновешивает силу тяжести, то акселерометр в этом случае будет измерять ускорение именно от тяги двигателя, которая «подменивает» силу реакции опоры для случая покоящегося на Земле ЛА.
… жаба опять одержала победу.
По мне 20 долларов + 15 за доставку = 35$ — дорого.
Поддерживаю. Главное мы друг друга поняли.
Сначала кратко поясню свое понимание калибровки акселерометров, а после как это можно применить к магнитометрам (как я понял).
Когда акселерометр лежит на горизонтальной поверхности мы знаем, что показания должны быть только по одной оси и значение нам известно. Но реально акселерометр будет показывать по остальным осям не нули, т.к. имеются смещения нуля и возможно оси акселерометра не совпадают с осями объекта. Путем поворота объекта с акселерометром на разные грани, мы получаем 6 измеренных векторов и 6 векторов, которые должны быть. Далее при помощи линейной алгебры мы находим матрицу, которая позволяет путем умножения показаний акселерометра, находящегося на объекте, лежащем на горизонтальной поверхности (к примеру), получить значения ускорения такие, каковыми они должны быть. Таким образом мы рассчитали матрицу, которая убирает «перекосы» осей координат (производит поворот), убирает смещения нуля (производит сдвиг (для этого у нас матрица размерностью 4х4)) и производит масштабирование (лежащий на плоскости объект будет измерять силу реакции опоры, равную ускорению свободного падения, примерно 9.81 м/с^2). Надеюсь правильно понял?
Теперь как этот же алгоритм можно применить к калибровки магнитометра? Для этого нужно знать направление вектора магнитного поля Земли. Далее поочередно ориентируя на это направление разные оси ОБЪЕКТА разными направлениями мы так же получаем 6 векторов измерений, а 6 значений, которые должны быть — мы знаем. Далее все то же самое. При помощи линейной алгебры находим калибровочную матрицу. Вот так я понял Ваши предложения использовать методику, описанную в статье применительно к магнитометрам. Я ошибся? (без сарказма)
Если таким образом калибровать магнитометр, то сначала необходимо найти направление вектора магнитного поля Земли. Идея в том, чтоб вращая магнитометр найти положение, при котором по двум осям будут нули, тогда оставшаяся ось указывает направление вектора магнитного поля. Но как направлена ось магнитометра по отношению к объекту? Или даже по отношению к корпусу микросхемы? Нет гарантии, что линия, вдоль грани микросхемы однозначно соответствует оси чувствительности магнитометра.
Кстати, я предполагал, что после нахождения таким образом «направления», фиксировалось положение объекта и считалось, что он направлен по вектору магнитного поля. В дальнейшем осуществлялось изменение положения объекта (для набора 6 векторов измерений) относительно этого фиксированного положения. Это были мои домыслы. А как делали Вы?
Методика (Appendix C) действительно громоздкая, но она позволяет избежать необходимости определения вектора магнитного поля, которое всегда определяется с ошибкой. Никому не навязываю использовать только ее. Уверен, что существуют и другие методики (проще, сложнее, точнее, грубее). Каждый для себя выбирает ту, которая больше удовлетворяет его задачам.
Вот такие вот пару слов. :)
Этот метод плох тем, что располагая так датчик вы совместите ось датчика с направлением на вектор, а для устранения перекосов необходимо совмещать ось объекта. Если есть возможность замерить углы, задающие направление вектора магнитного поля, то можно будет откалибровать, путем учета этого направления в математике. Но боюсь, что точность измерения этих углов будет крайне мала, что неизбежно повлияет на точность калибровки. Все же метод, описанный в документе, как мне кажется, более удобен, точен и прост.
как раз и была попытка откалибровать все одним заходом.
Может быть мы по разному понимаем слово калибровка? Под калибровкой я понимаю как раз совмещение осей датчика и объекта, а также масштабирование и устранение нулей.
Абсолютно ничего. Я и не думал. Просто как мне кажется, в этом документе хорошо расписано, как проводить калибровки. Способ найти направление вектора магнитной индукции, а после проводить калибровку так же, как и акселерометров — лично мне кажется не очень удобным. Результат сильно зависит от точности нахождения этого направления и возможности его поддержания неизменным (чтоб можно было переворачивать объект). Хотя и способ вращения вокруг осей объекта (метод описанный в документы к прибору) тоже не очень удобен.
В том-то и дело, что направление вектора магнитной индукции зависит от географического местоположения. Посмотрите документ, на который есть ссылка комментариях выше. Там расписана методика калибровки магнитометра. Причем там еще используется метод наименьших квадратов (как впрочем и при калибровке акселерометра).
Что касается самой матрицы калибровки. Она по сути состоит из трех матриц.
Одна матрица служит для поворота осей измерения датчика к осям объекта (немного грубо, но смысл думаю понятен). При умножении единичного вектора на эту матрицу длина вектора не изменяется, т.е. остается единичной. Происходит только поворот этого вектора.
Вторая матрица убирает смещения нуля или с точки зрения математики осуществляет сдвиг системы координат.
Ну и третья матрица служит для масштабирования коэффициентов передачи по каждому из направлений. В идеале это должна быть единичная матрица (по главной диагонали — 1, а остальные элементы — 0). Но после калибровки элементы главной диагонали будут иными.
Так вот, если все эти три матрицы перемножить, то получится необходимая нам матрица, на которую необходимо умножать измерения датчиков.
В одном из комментариев выше я говорил, что после калибровки акселерометра только часть полученной матрицы можно использовать для магнитометров, для поворота осей датчика. Устранить нули и провести масштабирование измерений магнитометра калибровкой одного только акселерометра не получится. Но пообщавшись сегодня с одним специалистом выяснилось следующее. Даже в этом датчике направление осей магнитометра и акселерометра не совпадают. К примеру оси Z у датчиков направлены в разные стороны. Кроме того специалист мне подсказал, что нет гарантии, что оси акселерометра и магнитометра вообще соосны, вот почему и проводятся калибровки для этих датчик.
В статье предлагается сделать определение матрицы с использованием одного замера в каждом из положений, но лучше использовать несколько замеров в каждом положении. Это позволит точнее определить матрицу, т.к. измерения всех датчиков «шумят».
В качестве информации предлагаю посмотреть документ Using LSM303DLH for a tilt compensated electronic compass. В нем достаточно подробно расписана методика калибровки акселерометра и магнитометра, ну разве что на английском. Методика позволяет провести масштабирование коэффициентов по всем осям, убрать смещения нуля и перекосы осей датчиков и объекта. Лично я использовал эту методику для своих задач — работает!
Но на самом деле так делать можно только при небольших углах и то результат будет приближенный. Реально же необходимо интегрировать кинематические уравнения углового движения (например в направляющих косинусах). В результате интегрирования мы получаем угловое положение ЛА относительно ИСК, имея угловые скорости ЛА, в проекциях на ССК.
Нельзя просто проинтегрировать показания датчиков угловой скорости (которые часто называют гироскопами, что не совсем верно), закрепленных на корпусе ЛА. Полученные таким образом углы не будут отражать угловое положение ЛА в ИСК.
Очень достойная книга по БИНС. Настоятельно рекомендую к прочтению.
думаю, что это вряд ли. Сделал простую прикидку. Если взять акселерометр, с диапазоном измерения +/-2g и предположим, что преобразователь у нас 16-ти разрядный, то 1 разряд будет равен примерно 0,000006 g. Согласно ГОСТу ПЗ-90 (Параметры Земли) такое изменение ускорения свободного падения будет наблюдаться при подъеме на высоту 200 метров (если на экваторе). Обычно показания акселерометров «шумят» 2-4 разряда, что будет соответствует разбросу высот 400-800 метров. Думаю, что не многие любительские коптеры летают на бОльших высотах, поэтому изменением ускорения свободного падения с высотой можно пренебречь (во всяком случае на первых порах).
Позвольте мне немного подправить понимание того, что измеряет акселерометр. Согласно определению акселерометр — прибор, измеряющий проекцию кажущегося ускорения. Кажущееся ускорение — это ускорение, возникающее под действием негравитационных сил, т.е. акселерометр не может измерять ускорение свободного падения (g). Тогда возникает, что же измеряет акселерометр, находящийся в покое на Земле? А измеряет он ускорение от силы реакции опоры (согласно 3-ему закону Ньютона). Если внимательно посмотреть в какую сторону направленна сила, ускорение от которой измеряет покоящийся акселерометр, то она направлена вверх, а не вниз, как сила тяжести.
Летательный аппарат (ЛА), который находится в состоянии свободного падения будет измерять только ускорение, возникшее от силы аэродинамического сопротивления воздуха (т.к. реакции опоры не будет), которое очень мало и я не уверен, что MEMS акселерометр измерит его (хотя можно и оценить). Если ЛА «зависат» в воздухе, т.е. сила тяги двигателей уравновешивает силу тяжести, то акселерометр в этом случае будет измерять ускорение именно от тяги двигателя, которая «подменивает» силу реакции опоры для случая покоящегося на Земле ЛА.