Search in topic
Создание собственной системы стабилизации

SergDoc

rual добил PPM на нужный канал, теперь всё красиво подключается обычным трёхконтактным шнурком 😃!!!

rual

Даёшь видеодемострацию полёта!!!

SergDoc

Шо? Опять я?😃
хм… А ведь да можно летать 😃 и чё это я? только это, удержание позиции пока не покажу - gps мой вечно жалуется на жисть плохую 😦 блин и спутники даже на кухне находит, а позиционирование никакое 😦 может метров на 40 прыгнуть…

rual
SergDoc:

gps мой вечно жалуется на жисть плохую

Который Навис? Странно, у мну никогда не жаловался, принимаем на обрывок провода.

Без удержания не интересно, это и кук может.

SergDoc
rual:

Который Навис?

Не MTK 3329, Навис я так и не доделал 😦 надо антенну купить, а как-то всё нет аказии… я ещё невзначай brd удалил надо переразвести, а времени последнее время как-то небыло…

mataor

народ… вопрос на засыпку…

  1. спи у вас на прерывании или тупо отослал/принял? лично мне первый вариантом не совсем нравится (может и зависнуть…)
  2. вчера ковырялся с ст-шными датчиками (lsm303l и l3gd20)… регистр читается, вроде как пишется… а вот 6 подряд (в посылаемом байте 7-й бит - RD, 6-й - автоинкремент) - творится чот непонятное… вот думаю подключит их для начала по и2с и проверить на корректность, но вдруг?
SergDoc

Там читается хитрО не как в остальных датчиках там к адресу первого(с которого прочитать надо) регистра чёт прибавить надо - блин уже и не помню 😦

Alexey_1811

Если читать несколько регистров подряд то в адресе нужно определенный битик поднять.

SergDoc

во как в 330-й было

LSM330_OUT_X_L_G +0x80, 6, buf// к адресу регистра цыфирка прибавляеццо
mataor
mataor:

6-й - автоинкремен

SergDoc:

Там читается хитрО не как в остальных датчиках там к адресу первого(с которого прочитать надо) регистра чёт прибавить надо

Alexey_1811:

то в адресе нужно определенный битик поднять.

я про это ж и написал…

кароч придется вначале проверить через и2с а потом уже дальше экспериментировать

ну или попробовать каждый регистр отдельно почитать…

SergDoc

Вот как я с MPU делал…

static void mpu6000AccRead(int16_t *accData)
{
    uint8_t buf[6];
    uint8_t i;
      MPU_ON;// прижал
      spi_writeByte(MPU_RA_ACCEL_XOUT_H | 0x80);
            for (i = 0; i < 6; i++)
    buf[i] = spi_readByte();
    MPU_OFF;//отпустил
    accData[0] = (int16_t)((buf[0] << 8) | buf[1]) / 8;
    accData[1] = (int16_t)((buf[2] << 8) | buf[3]) / 8;
    accData[2] = (int16_t)((buf[4] << 8) | buf[5]) / 8;
}
///////////////////////////////////////////////////////////////////////////

uint8_t spi_writeByte(uint8_t Data)
{
    /* Wait until the transmit buffer is empty */
    while(SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_BSY) == SET);
    SPI_I2S_SendData(SPI1, Data);
    while(SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_BSY) == SET);
    return SPI_I2S_ReceiveData(SPI1);
}


uint8_t spi_readByte(void)
{
    volatile uint8_t data = 0;
    while(SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_BSY) == SET);
    SPI_I2S_SendData(SPI1,0xFF);         // Dummy Byte
    while(SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_BSY) == SET);
    data = SPI_I2S_ReceiveData(SPI1);
    /* Return the shifted data */
    return data;
}
rual
mataor:

спи у вас на прерывании или тупо отослал/принял? лично мне первый вариантом не совсем нравится (может и зависнуть…)

У меня с прерываниями, в ПХ4 без. Зависнуть может, но для этого должен быть серьёзный сбой проца и датчика, что врятли они после этого будут правильно работать.

oleg70
Sir_Alex:

Грубо говоря, он 200 раз в секунду, раскладывает сигнал на частоты и отсеивает все что больше

Как это он “сигнал раскладывает” ??
Он просто может делать выборки АЦП не каждый такт, а через такт, через два и т.д…
(в зависимости от настройки DLPF, этож железка…), выдавать он будет со своей частотой опроса, но фактически пойдут повторы данных ниже частоты среза…
А про какой то встроенный алгоритм фильтрации по “раскладыванию” я так ничего в документах и не нашел, Вы где то читали (?) поделитесь плиз…

SergDoc:

блин и спутники даже на кухне находит, а позиционирование никакое может метров на 40 прыгнуть…

А математика какая по расчету позиции/расстояния ?? или это “черный ящик” ?
Я себе сделал на гаверсинусах… вроде похоже на правду выдает, но окончательно сказать пока трудно, надо погулять с железом по улице (пока только дома смотрю).

djdron

Может внутри какой-нибудь БИХ фильтр, т.к. от частоты среза меняется задержка.
Кстати, какие в PX4 для USB VID и PID, определяется в системе как HID устройство или как-то подругому?

mataor

хмм… ошибку как бы нашел, читаются все 6 регистров последовательно нормально… но мало помогло:
если читать редко - то все ок. (с выводом на уарт через 50-200мс),
как запускаешь код вия - херня всякая вместо данных.
пробовал даже считывать и проверять регистр статуса на наличие новых данных - все равно такая же канитель…

Sir_Alex
oleg70:

Как это он “сигнал раскладывает” ??

Например FFT(БПФ) - это не суть важно, да и не знаю, какие алгоритмы зашиты в MPU. Кстати, MPU - это не тупой аналоговый датчик с АЦП преобразователем. Там стоит процессор, который обрабатывает поступающие сигналы и выдает отфильтрованные. И он даже умеет делать Sensor Fusion (и на выходе уже выдавать углы Эйлера).

Но что бы вы разобрались, вот картинка данных, полученных с гироскопа:

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

SergDoc
djdron:

какие в PX4 для USB VID и PID, определяется в системе как HID устройство или как-то подругому?

определяется как com-порт id не помню - в виндовом драйвере посмотреть можно, они в самом низу драйвера прописаны…

djdron
SergDoc:

определяется как com-порт id не помню - в виндовом драйвере посмотреть можно, они в самом низу драйвера прописаны…

видно используют библиотеку от ST, было интересно как с лицензией на usb поступили))

mahowik
Sir_Alex:

Например FFT

FFT он вряд ли делает… ресурсов не хватит… скорее всего там обычный цифровой НЧ фильтр (DLPF), который как раз и дает смещение/задержку фазы сигнала как на картинке…

вот пример простого в понимании дискретного LPF с заданием нужной частоты среза:

    /// Low pass filter cut frequency
    float filter = 7.9577e-3; // Set to  "1 / ( 2 * PI * f_cut )";

    // Examples for _filter:
    // f_cut = 10 Hz -> _filter = 15.9155e-3
    // f_cut = 15 Hz -> _filter = 10.6103e-3
    // f_cut = 20 Hz -> _filter =  7.9577e-3
    // f_cut = 25 Hz -> _filter =  6.3662e-3
    // f_cut = 30 Hz -> _filter =  5.3052e-3

    // discrete low pass filter, cuts out the high frequency noise, where dt in seconds
    value = value + (dt / ( filter + dt)) * (value - lastValue);

    lastValue = value;

Т.е. чем ниже частота сигнала на входе (чем выше dt), тем большая часть приращения (разность между текущим и пред-м значениями) идет в результат…

п.с. Редко появляюсь тут сейчас. Звиняйте если шо пропустил 😃

mahowik

upd: ошибочка

...
value = lastValue + (dt / ( filter + dt)) * (inputValue - lastValue);
...
rual
mataor:

если читать редко - то все ок. (с выводом на уарт через 50-200мс),
как запускаешь код вия - херня всякая вместо данных.

Пробовал считывать все регистры данных по и2ц 250 раз в сек, никаких сбоев не было. Смотри код, прежде всего работу с и2ц. По СТМ32 могу помочь, если код покажешь.

djdron:

видно используют библиотеку от ST, было интересно как с лицензией на usb поступили))

Нет, не использует. В загрузчике свой код, в нутексе драйвер нутекса.