update
This commit is contained in:
199
contr.c
199
contr.c
@@ -7,6 +7,7 @@
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <math.h>
|
||||
|
||||
#include <avr/interrupt.h>
|
||||
#include <util/delay.h>
|
||||
@@ -29,11 +30,31 @@
|
||||
#define CONTR_BAND_40M 0x04
|
||||
#define CONTR_BAND_80M 0x05
|
||||
|
||||
#define CONR_VCCARR_SIZE 4
|
||||
#define CONR_PWRARR_SIZE 16
|
||||
|
||||
typedef struct {
|
||||
uint8_t band;
|
||||
uint16_t vcc;
|
||||
uint16_t cnt;
|
||||
uint16_t freq;
|
||||
uint16_t cnt;
|
||||
|
||||
uint16_t vccs[CONR_VCCARR_SIZE];
|
||||
size_t vccp;
|
||||
float vcc;
|
||||
uint16_t vccr;
|
||||
|
||||
uint16_t fwd1s[CONR_PWRARR_SIZE];
|
||||
uint16_t fwd2s[CONR_PWRARR_SIZE];
|
||||
size_t fwd1p;
|
||||
size_t fwd2p;
|
||||
uint16_t fwd;
|
||||
|
||||
uint16_t rev1s[CONR_PWRARR_SIZE];
|
||||
uint16_t rev2s[CONR_PWRARR_SIZE];
|
||||
size_t rev1p;
|
||||
size_t rev2p;
|
||||
uint16_t rev;
|
||||
|
||||
} contr_t;
|
||||
|
||||
contr_t contr;
|
||||
@@ -45,21 +66,99 @@ void contr_read_band(void);
|
||||
|
||||
void contr_init(void) {
|
||||
contr.band = CONTR_BAND_OFF;
|
||||
contr.vccp = 0;
|
||||
for (size_t i = 0; i < CONR_VCCARR_SIZE; i++) contr.vccs[i] = 0;
|
||||
|
||||
contr.fwd1p = 0;
|
||||
contr.fwd2p = 0;
|
||||
contr.fwd2p = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) contr.fwd1s[i] = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) contr.fwd2s[i] = 0;
|
||||
contr.fwd = 0;
|
||||
|
||||
contr.rev1p = 0;
|
||||
contr.rev2p = 0;
|
||||
contr.rev2p = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) contr.rev1s[i] = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) contr.rev2s[i] = 0;
|
||||
contr.rev = 0;
|
||||
}
|
||||
void contr_setup(void) {
|
||||
contr_read_band();
|
||||
}
|
||||
|
||||
void contr_measure_vcc() {
|
||||
contr.vcc = adc_read(ACD_CHANELL3);
|
||||
#define CONTR_VCC_SCALE 270.0F
|
||||
void contr_measure_vcc(void) {
|
||||
contr.vccr = adc_read(ACD_CHANELL3);
|
||||
}
|
||||
|
||||
|
||||
#define CONTR_VCC_SCALE 2700.0F
|
||||
float contr_get_vcc() {
|
||||
return (float)contr.vcc / CONTR_VCC_SCALE;
|
||||
void contr_calc_vcc(void) {
|
||||
contr.vcc = lroundf((float)contr.vccr / CONTR_VCC_SCALE) / 10.0F;
|
||||
}
|
||||
|
||||
float contr_get_vcc(void) {
|
||||
return contr.vcc;
|
||||
}
|
||||
|
||||
#define CONTR_FWD_SCALE 370
|
||||
void contr_measure_fwd(void) {
|
||||
contr.fwd1s[contr.fwd1p] = adc_read(ACD_CHANELL1);
|
||||
contr.fwd1p++;
|
||||
if ((contr.fwd1p) > CONR_PWRARR_SIZE) {
|
||||
contr.fwd1p = 0;
|
||||
if ((++(contr.fwd2p)) > CONR_PWRARR_SIZE) {
|
||||
contr.fwd2p = 0;
|
||||
}
|
||||
uint32_t summ = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) {
|
||||
summ += contr.fwd1s[i];
|
||||
}
|
||||
contr.fwd2s[contr.fwd2p] = (uint16_t)(summ / CONR_PWRARR_SIZE);
|
||||
}
|
||||
}
|
||||
|
||||
void contr_calc_fwd(void) {
|
||||
uint32_t summ = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) {
|
||||
summ += contr.fwd2s[i];
|
||||
}
|
||||
summ /= CONR_PWRARR_SIZE;
|
||||
contr.fwd = summ / CONTR_FWD_SCALE;
|
||||
}
|
||||
|
||||
uint16_t contr_get_fwd(void) {
|
||||
return contr.fwd;
|
||||
}
|
||||
|
||||
#define CONTR_REV_SCALE 28
|
||||
void contr_measure_rev(void) {
|
||||
contr.rev1s[contr.rev1p] = adc_read(ACD_CHANELL0);
|
||||
contr.rev1p++;
|
||||
if ((contr.rev1p) > CONR_PWRARR_SIZE) {
|
||||
contr.rev1p = 0;
|
||||
if ((++(contr.rev2p)) > CONR_PWRARR_SIZE) {
|
||||
contr.rev2p = 0;
|
||||
}
|
||||
uint32_t summ = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) {
|
||||
summ += contr.rev1s[i];
|
||||
}
|
||||
contr.rev2s[contr.rev2p] = (summ / CONR_PWRARR_SIZE);
|
||||
}
|
||||
}
|
||||
|
||||
void contr_calc_rev(void) {
|
||||
uint32_t summ = 0;
|
||||
for (size_t i = 0; i < CONR_PWRARR_SIZE; i++) {
|
||||
summ += contr.rev2s[i];
|
||||
}
|
||||
summ /= CONR_PWRARR_SIZE;
|
||||
contr.rev = summ / CONTR_REV_SCALE;
|
||||
}
|
||||
|
||||
uint16_t contr_get_rev(void) {
|
||||
return contr.rev;
|
||||
}
|
||||
|
||||
void contr_switch_band(void) {
|
||||
switch (contr.band) {
|
||||
@@ -81,26 +180,33 @@ void contr_switch_band(void) {
|
||||
}
|
||||
|
||||
void contr_set_band(uint8_t band) {
|
||||
relaytx_off();
|
||||
ampl_off();
|
||||
contr.band = band;
|
||||
|
||||
relay80m_off();
|
||||
relay40m_off();
|
||||
relay20m_off();
|
||||
relay10m_off();
|
||||
|
||||
switch (contr.band) {
|
||||
case CONTR_BAND_10M:
|
||||
relay10m_on();
|
||||
filter80m_off();
|
||||
filter40m_off();
|
||||
filter20m_off();
|
||||
filter10m_on();
|
||||
break;
|
||||
case CONTR_BAND_20M:
|
||||
relay20m_on();
|
||||
filter80m_off();
|
||||
filter40m_off();
|
||||
filter10m_off();
|
||||
filter20m_on();
|
||||
break;
|
||||
case CONTR_BAND_40M:
|
||||
relay40m_on();
|
||||
filter80m_off();
|
||||
filter20m_off();
|
||||
filter10m_off();
|
||||
filter40m_on();
|
||||
break;
|
||||
case CONTR_BAND_80M:
|
||||
relay80m_on();
|
||||
filter40m_off();
|
||||
filter20m_off();
|
||||
filter10m_off();
|
||||
filter80m_on();
|
||||
break;
|
||||
default:
|
||||
break;
|
||||
@@ -158,12 +264,12 @@ void contr_show_logo(void) {
|
||||
}
|
||||
|
||||
void contr_show_band(void) {
|
||||
disp_string(0, 13, contr_get_bandname(contr.band));
|
||||
disp_string(0, 13, contr_get_bandname());
|
||||
}
|
||||
|
||||
void contr_show_vcc(void) {
|
||||
char buffer[12] = { '\0' };
|
||||
sprintf(buffer, "%03.1fv", contr_get_vcc());
|
||||
sprintf(buffer, "%4.1fv", contr_get_vcc());
|
||||
disp_string(3, 11, buffer);
|
||||
}
|
||||
|
||||
@@ -176,10 +282,15 @@ void contr_show_ptt(void) {
|
||||
}
|
||||
|
||||
ISR(TIMER0_OVF_vect) {
|
||||
contr_measure_vcc();
|
||||
contr_measure_fwd();
|
||||
contr_measure_rev();
|
||||
contr.freq = contr.cnt;
|
||||
contr.cnt = 0;
|
||||
button_handle();
|
||||
uart_handle();
|
||||
contr_calc_fwd();
|
||||
contr_calc_rev();
|
||||
}
|
||||
|
||||
ISR(TIMER1_OVF_vect) {
|
||||
@@ -187,10 +298,43 @@ ISR(TIMER1_OVF_vect) {
|
||||
REG_SETUP(TCNT1, TIMER1_PRESIZE);
|
||||
}
|
||||
|
||||
#define CONTR_FREQ_SCALE 2
|
||||
uint16_t contr_get_freq(void) {
|
||||
return contr.freq / CONTR_FREQ_SCALE;
|
||||
}
|
||||
|
||||
void contr_show_freq(void) {
|
||||
char buffer[12] = { '\0' };
|
||||
sprintf(buffer, "%2.0fM", (float)contr.freq / 16.05F);
|
||||
disp_string(0, 0, buffer);
|
||||
uint16_t freq = contr_get_freq();
|
||||
|
||||
sprintf(buffer, "%5uM", freq);
|
||||
disp_string(0, 0, buffer);
|
||||
}
|
||||
|
||||
void contr_show_fwd(void) {
|
||||
char buffer[12] = { '\0' };
|
||||
sprintf(buffer, "F %7uw", contr_get_fwd());
|
||||
disp_string(1, 2, buffer);
|
||||
}
|
||||
|
||||
void contr_show_rev(void) {
|
||||
char buffer[12] = { '\0' };
|
||||
sprintf(buffer, "R %7uw", contr_get_rev());
|
||||
disp_string(2, 2, buffer);
|
||||
}
|
||||
|
||||
void contr_show_swr(void) {
|
||||
char buffer[12] = { '\0' };
|
||||
uint16_t fwd = contr_get_fwd();
|
||||
uint16_t rev = contr_get_rev();
|
||||
uint16_t diff = (fwd - rev);
|
||||
|
||||
uint16_t swr = 0;
|
||||
if (diff != 0) {
|
||||
swr =((fwd + rev) * 100) / diff;
|
||||
}
|
||||
sprintf(buffer, " %u", swr);
|
||||
disp_string(2, 2, buffer);
|
||||
}
|
||||
|
||||
void contr_main(void) {
|
||||
@@ -199,7 +343,10 @@ void contr_main(void) {
|
||||
while (true) {
|
||||
contr_show_ptt();
|
||||
contr_button_eval();
|
||||
contr_measure_vcc();
|
||||
//contr_calc_vcc();
|
||||
//contr_show_fwd();
|
||||
//contr_show_rev();
|
||||
contr_show_swr();
|
||||
contr_show_vcc();
|
||||
contr_show_band();
|
||||
contr_show_freq();
|
||||
@@ -208,11 +355,13 @@ void contr_main(void) {
|
||||
}
|
||||
}
|
||||
|
||||
#define CONTR_BAND_EEPROM_ADDR 0x00
|
||||
|
||||
void contr_write_band(void) {
|
||||
eeprom_write_bytes(0x00, &contr.band, sizeof(contr.band));
|
||||
eeprom_write_bytes(CONTR_BAND_EEPROM_ADDR, &contr.band, sizeof(contr.band));
|
||||
}
|
||||
|
||||
void contr_read_band(void) {
|
||||
eeprom_read_bytes(0x00, &contr.band, sizeof(contr.band));
|
||||
eeprom_read_bytes(CONTR_BAND_EEPROM_ADDR, &contr.band, sizeof(contr.band));
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user