27.06.2019 Добавление новых сигналов в RTKLIB
Содержание |
Это моя статья
А это введение моей статьи.
Постановка задачи
Возможности RTKNAVI позволяют отображать сигналы L2С и L5 - единственным препятствием для этого являлось отсутствие необходимого кода в обрабатывающем фале nvs.c. Проблема решалась в несколько этапов c использовнием IDE Embarcadero RAD Studio.
Задача и подзадачи
Был изучен протокол информационного взаимодействия СРНС.
Конкретно интерес представлял пакет F5, т.к. содержит информацию о типах сигналов. В протоколе эти типы представлены в виде шестнадцатерничных значений, однако , чтобы программа смогла "опознать" соответствующие типы, их необходимо перевести в децимальную систему счисления. Выполняя это простое преобразование, нетрудно убедиться, что сигналу L2C соответствует значение 34, а сигналу L5 - 66. Далее полученные значения добавляются в условие соответствующего цикла, отвечающего за идентификацию навигационных сигналов систем ГЛОНАСС и GPS. На этом этапе программа может "отличить" (но пока не показать! Как добиться их отображения рассказано ниже) сигналы L2C и L5 от сигналов системы ГЛОНАСС.
raw->obs.data[n].time = time;
sys = (U1(p)==1 || U1(p)==33)?SYS_GLO:((U1(p)==2 || U1(p)==34 ||U1(p)==66)?SYS_GPS:((U1(p)==4)?SYS_SBS:SYS_NONE));
Теперь же возникла другая подзадача - необходимо, чтобы L2C и L5 и L1 могли идентифицироваться и впоследствии отображаться независимо друг от друга.
В предыдущей версии программы стояла аналогичная проблема с разделением сигналов L1С/А и L2OF для системы ГЛОНАСС. Там она была решена введением воспомогательной переменной "bandnum", которая принимала значение, равное 1 исключительно при поступлении типа сигнала L2OF и нулевые при всех остальных. В текущей задаче можно использовать эту переменную для идентификации L2C, поэтому достаточно лишь дополнить условие, при котором переменная принимает единичное значение. Теперь она принимает это значение уже при для двух типов сигналов разных навигационных систем. Далее выполняем аналогичные действия для сигнала L5 и вводим вспомогательную переменную "initnum", которая принимает значение 2 (почему именно 2 будет сказано ниже).
initnum = 2; /* L5 */
}
else {
initnum = 0;
}
if (U1(p)==33 || U1(p)==34) {
bandnum = 1; /* L2 */
} else
bandnum = 0;
Далее необходимо обеспечить вывод соответствующих выходных переменных (P, L, D) на форму приложения.
Для этого необходимо выполнить редактирование соответствующего участка кода с использованием введенных воспомогательных переменных. При нулевых значениях обеих переменных данные будут выводиться, в , соответственно P[0], L[0], D[0] (которые соответствуют сигналу L1), в остальных столбцах (при данном значении строки, соответствующей конкретному спутнику) происходит заполнение нулевыми значениями. Для простоты операцию "И" можно заменить суммой, которая будет принимать нулевое значение только при одновременных ( в одной итерации) нулевых значении значениях переменных "bandnum" и "initnum". Если же хотя бы одна из воспомогательных переменных принимает ненулевое значение, то далее на форму осуществляется вывод значений для частотных диапазонов либо L2(bandnum =1), либо L5 (initnum = 2). Ниже представлен фрагмент кода с выводом на форму значений L для сигналов L1, L2 и L5.
if (bandnum+initnum == 0) {
raw->obs.data[n].L[0] = Lb - toff*(FREQ1); }
else {
if (initnum == 2) {
raw->obs.data[n].L[2] = Lb - toff*(FREQ5); }
else {
raw->obs.data[n].L[1] = Lb - toff*(FREQ2); }
}
} else {
if (bandnum == 0) {
raw->obs.data[n].L[0] = Lb - toff*(FREQ1_GLO+DFRQ1_GLO*carrNo);
}
else {
raw->obs.data[n].L[1] = Lb - toff*(FREQ2_GLO+DFRQ2_GLO*carrNo);
} }
Аналогично используем воспомогательные переменные для разделения значений дальности (P) и доплеровской частоты (D).
Здесь и играет роль в упрощении редактирования (и как следствие, получаем меньшую разницу с исходным кодом) кода выбор в качестве ненулевого значения переменной initnum 2. Здесь переменная сразу задает нужный столбец, минуя предусловий с отдельным прописыванием значений столбцов, как это было в случае с L.
raw->obs.data[n].P[bandnum] = (Pb-dTowFrac)*CLIGHT*0.001 - toff*CLIGHT; /* in ms, needs to be converted */
raw->obs.data[n].D[bandnum] = (float)Db; }
else {
raw->obs.data[n].P[initnum] = (Pb-dTowFrac)*CLIGHT*0.001 - toff*CLIGHT; /* in ms, needs to be converted */
raw->obs.data[n].D[initnum] = (float)Db; }
Действия, аналогичные изложенным выше для L выполняем для I.
raw->obs.data[n].code[0] = CODE_L1C;
raw->obs.data[n].sat = sat;
} else {
if(sys==SYS_GPS) {
if(initnum == 2) {
raw->obs.data[n].code[initnum] = CODE_L5I;
}
else {
if(bandnum == 1) {
raw->obs.data[n].code[initnum] = CODE_L2C;
}
else {
raw->obs.data[n].code[initnum] = CODE_L1C;
}
}
}
else{
if(bandnum == 1) {
raw->obs.data[n].code[bandnum] = CODE_L2C; }
else {
raw->obs.data[n].code[bandnum] = CODE_L1C;
}
}
}
Последний штрих - необходимо дополнить участок кода, отвечающий за заполнение элементов таблицы формы нулями. В предыдущей версии там уже была учтена переменная bandnum, осталось учесть введенную переменную initnum. Заполнение нулями столбцов происходит, если обе переменные равны нулю.
for (j=1;j<NFREQ+NEXOBS;j++) {
raw->obs.data[n].L[j]=raw->obs.data[n].P[j]=0.0;
raw->obs.data[n].D[j]=0.0;
raw->obs.data[n].SNR[j]=raw->obs.data[n].LLI[j]=0;
raw->obs.data[n].code[j]=CODE_NONE;
}
После проведения компиляции, убеждаемся, что нет синтаксических ошибок.
Эксперимент
С использованием двух приемников были записаны логи и проверена работоспособность измененной программы. Нетрудно увидеть, что программа работает корректно и выдает ожидаемый результат - есть отображение сигналов L2 и L5.
Схожий эксперимент был проведен со вторым приемником, только на сей раз L5 уже не увидеть - этот приемник не поддерживает его прием.
Ссылки
Сборки exe-шников с учетом изменений
[ Хронологический вид ]Комментарии
Войдите, чтобы комментировать.