1st
Wojciech Kaczmarski
GitHub
parent
06be2272bc
commit
8cac698250
|
|
@ -0,0 +1,267 @@
|
|||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <stdint.h>
|
||||
#include <string.h>
|
||||
|
||||
#define MAX_CHANNELS_PER_BANK 20 //max channels allowed in a bank
|
||||
#define MAX_NAME_LEN 12+1 //max text length (except for VERSION -> 20)
|
||||
#define MAX_BANK_NUM 100 //bank capacity in channels
|
||||
|
||||
#define K_AUTHOR "author"
|
||||
#define AUTHOR 1
|
||||
#define K_VERSION "version"
|
||||
#define VERSION 2
|
||||
|
||||
#define K_NUM_BANKS "num_banks"
|
||||
#define NUM_BANKS 3
|
||||
#define K_NUM "num"
|
||||
#define NUM 4
|
||||
#define K_NAME "name"
|
||||
#define NAME 5
|
||||
#define K_NUM_CHANNELS "num_channels"
|
||||
#define NUM_CHANNELS 6
|
||||
#define K_DESCR "descr"
|
||||
#define DESCR 7
|
||||
#define K_FREQ "freq"
|
||||
#define FREQ 8
|
||||
#define K_ENCR "encr"
|
||||
#define ENCR 9
|
||||
#define K_GPS "gps"
|
||||
#define GPS 10
|
||||
|
||||
#define EMPTY_OR_COMMENT 255
|
||||
|
||||
#define K_CODEPLUG "codeplug"
|
||||
#define CODEPLUG 100
|
||||
#define K_BANK "bank"
|
||||
#define BANK 101
|
||||
#define K_CHANNEL "channel"
|
||||
#define CHANNEL 102
|
||||
#define K_END "end"
|
||||
#define END 200
|
||||
|
||||
uint8_t in_codeplug=0, in_bank=0, in_channel=0; //where are we?
|
||||
uint8_t bank_num=0, channel_num=0; //
|
||||
|
||||
struct CHANNEL_DATA {
|
||||
volatile uint8_t name[MAX_NAME_LEN]; //channel name
|
||||
volatile uint8_t descr[MAX_NAME_LEN]; //channel description
|
||||
volatile uint32_t freq; //frequency in Hz
|
||||
volatile uint8_t enc_type; //encryption type
|
||||
volatile uint8_t gps; //gps data transmission type
|
||||
volatile uint16_t tg_id; //talkgroup ID
|
||||
};
|
||||
|
||||
struct BANK_DATA {
|
||||
volatile uint8_t name[MAX_NAME_LEN];
|
||||
volatile uint8_t num_channels;
|
||||
struct CHANNEL_DATA channel[MAX_CHANNELS_PER_BANK];
|
||||
};
|
||||
|
||||
struct CODEPLUG_DATA {
|
||||
volatile uint8_t author[MAX_NAME_LEN];
|
||||
volatile uint8_t version[20];
|
||||
volatile uint8_t name[MAX_NAME_LEN];
|
||||
volatile uint16_t num_banks;
|
||||
struct BANK_DATA bank[MAX_BANK_NUM];
|
||||
};
|
||||
|
||||
struct CODEPLUG_DATA codeplug;
|
||||
|
||||
FILE *cp_fil;
|
||||
|
||||
uint8_t file_line[1000][256];
|
||||
uint32_t lines=0;
|
||||
|
||||
uint8_t test[256];
|
||||
|
||||
uint32_t extractValue(uint8_t *line)
|
||||
{
|
||||
for(uint16_t i=0; i<255; i++)
|
||||
{
|
||||
if(line[i]=='=')
|
||||
return atoi(&line[i+1]);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
void extractString(uint8_t *line, uint8_t *dest)
|
||||
{
|
||||
for(uint16_t i=0; i<255; i++)
|
||||
{
|
||||
if(line[i]=='"')
|
||||
{
|
||||
uint8_t cnt=0;
|
||||
|
||||
while(line[i+1+cnt]!='"')
|
||||
{
|
||||
dest[cnt]=line[i+1+cnt++];
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
uint8_t extractType(uint8_t *line)
|
||||
{
|
||||
//comment
|
||||
if(line[0]=='#')
|
||||
return EMPTY_OR_COMMENT;
|
||||
else if(strstr(line, K_CODEPLUG) != NULL)
|
||||
return CODEPLUG;
|
||||
else if(strstr(line, K_AUTHOR) != NULL)
|
||||
return AUTHOR;
|
||||
else if(strstr(line, K_VERSION) != NULL)
|
||||
return VERSION;
|
||||
else if(strstr(line, K_NUM_BANKS) != NULL)
|
||||
return NUM_BANKS;
|
||||
else if(strstr(line, K_NUM_CHANNELS) != NULL)
|
||||
return NUM_CHANNELS;
|
||||
else if(strstr(line, K_NUM) != NULL)
|
||||
return NUM;
|
||||
else if(strstr(line, K_FREQ) != NULL)
|
||||
return FREQ;
|
||||
else if(strstr(line, K_ENCR) != NULL)
|
||||
return ENCR;
|
||||
else if(strstr(line, K_GPS) != NULL)
|
||||
return GPS;
|
||||
else if(strstr(line, K_DESCR) != NULL)
|
||||
return DESCR;
|
||||
else if(strstr(line, K_NAME) != NULL)
|
||||
return NAME;
|
||||
|
||||
else if(strstr(line, K_BANK) != NULL)
|
||||
return BANK;
|
||||
else if(strstr(line, K_CHANNEL) != NULL)
|
||||
return CHANNEL;
|
||||
else if(strstr(line, K_END) != NULL)
|
||||
return END;
|
||||
|
||||
return EMPTY_OR_COMMENT;
|
||||
}
|
||||
|
||||
void parseCodeplug(struct CODEPLUG_DATA *cp)
|
||||
{
|
||||
for(uint8_t line=0; line<lines; line++)
|
||||
{
|
||||
if(extractType(file_line[line])==EMPTY_OR_COMMENT)
|
||||
continue;
|
||||
|
||||
switch(extractType(file_line[line]))
|
||||
{
|
||||
case CODEPLUG:
|
||||
in_codeplug=1;
|
||||
break;
|
||||
|
||||
case BANK:
|
||||
in_bank=1;
|
||||
bank_num++;
|
||||
break;
|
||||
|
||||
case CHANNEL:
|
||||
in_channel=1;
|
||||
channel_num++;
|
||||
break;
|
||||
|
||||
case END:
|
||||
if(in_channel)
|
||||
{in_channel=0; break;}
|
||||
if(in_bank)
|
||||
{in_bank=0; break;}
|
||||
if(in_codeplug)
|
||||
in_codeplug=0;
|
||||
break;
|
||||
|
||||
case AUTHOR:
|
||||
extractString(file_line[line], cp->author);
|
||||
break;
|
||||
|
||||
case VERSION:
|
||||
extractString(file_line[line], cp->version);
|
||||
break;
|
||||
|
||||
case NUM_BANKS:
|
||||
cp->num_banks=extractValue(file_line[line]);
|
||||
break;
|
||||
|
||||
case NUM_CHANNELS:
|
||||
cp->bank[bank_num-1].num_channels=extractValue(file_line[line]);
|
||||
break;
|
||||
|
||||
/*case NUM:
|
||||
if(in_bank && !in_channel)
|
||||
bank_num=extractValue(file_line[line]);
|
||||
else if(in_bank && in_channel)
|
||||
channel_num=extractValue(file_line[line]);
|
||||
break;*/
|
||||
|
||||
case NAME:
|
||||
if(in_bank && !in_channel)
|
||||
extractString(file_line[line], cp->bank[bank_num-1].name);
|
||||
else if(in_bank && in_channel)
|
||||
extractString(file_line[line], cp->bank[bank_num-1].channel[channel_num-1].name);
|
||||
break;
|
||||
|
||||
case DESCR:
|
||||
if(in_channel)
|
||||
extractString(file_line[line], cp->bank[bank_num-1].channel[channel_num-1].descr);
|
||||
break;
|
||||
|
||||
case FREQ:
|
||||
if(in_channel)
|
||||
cp->bank[bank_num-1].channel[channel_num-1].freq=extractValue(file_line[line]);
|
||||
break;
|
||||
|
||||
case ENCR:
|
||||
if(in_channel)
|
||||
cp->bank[bank_num-1].channel[channel_num-1].enc_type=extractValue(file_line[line]);
|
||||
break;
|
||||
|
||||
case GPS:
|
||||
if(in_channel)
|
||||
cp->bank[bank_num-1].channel[channel_num-1].gps=extractValue(file_line[line]);
|
||||
break;
|
||||
|
||||
default:
|
||||
;
|
||||
break;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
int main(void)
|
||||
{
|
||||
cp_fil = fopen("2600653.m17", "rb");
|
||||
|
||||
while(fgets(&file_line[lines++], 255, cp_fil)!=NULL);
|
||||
|
||||
printf("Loaded %d lines\n", lines);
|
||||
|
||||
parseCodeplug(&codeplug);
|
||||
|
||||
printf("Author: %s\n", codeplug.author);
|
||||
printf("Version: %s\n", codeplug.version);
|
||||
printf("Banks: %d\n\n", codeplug.num_banks);
|
||||
|
||||
for(uint8_t i=0; i<codeplug.num_banks; i++)
|
||||
{
|
||||
printf("Bank %d channels:\t%d\n", i, codeplug.bank[i].num_channels);
|
||||
printf("Bank %d name:\t\t%s\n\n", i, codeplug.bank[i].name);
|
||||
|
||||
for(uint8_t j=0; j<codeplug.bank[i].num_channels; j++)
|
||||
{
|
||||
printf("Bank %d Channel %d name:\t%s\n", i, j, codeplug.bank[i].channel[j].name);
|
||||
printf("Bank %d Channel %d descr:\t%s\n", i, j, codeplug.bank[i].channel[j].descr);
|
||||
printf("Bank %d Channel %d freq:\t%d\n", i, j, codeplug.bank[i].channel[j].freq);
|
||||
printf("Bank %d Channel %d encr:\t%d\n", i, j, codeplug.bank[i].channel[j].enc_type);
|
||||
printf("Bank %d Channel %d gps:\t%d\n", i, j, codeplug.bank[i].channel[j].gps);
|
||||
printf("\n");
|
||||
}
|
||||
}
|
||||
|
||||
fclose(cp_fil);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
Loading…
Reference in New Issue