This commit is contained in:
Wolfgang Hottgenroth 2024-06-15 23:16:26 +02:00
parent 7ddc7e8f71
commit d2d60b683d

View File

@ -12,9 +12,8 @@ const float BASE_FREQUENCY = 2457600.0;
const float MAIN_DIVIDER = 8388606.0; // 2^23 const float MAIN_DIVIDER = 8388606.0; // 2^23
static uint16_t frequencyToDivider(uint16_t freq) { static uint16_t frequencyToDivider(float freq) {
float f = (float) freq; float n = (freq * MAIN_DIVIDER) / BASE_FREQUENCY;
float n = (f * MAIN_DIVIDER) / BASE_FREQUENCY;
uint16_t i = (uint16_t) n; uint16_t i = (uint16_t) n;
if (n - i >= 0.5) { if (n - i >= 0.5) {
i += 1; i += 1;
@ -26,6 +25,7 @@ void generatorInit() {
P1DIR |= BIT0 | BIT1 | BIT2 | BIT3; P1DIR |= BIT0 | BIT1 | BIT2 | BIT3;
P1OUT |= BIT0 | BIT1 | BIT2 | BIT3; P1OUT |= BIT0 | BIT1 | BIT2 | BIT3;
genShifter(0, frequencyToDivider(441)); genShifter(0, frequencyToDivider(1000));
genShifter(1, frequencyToDivider(10));
} }