Initial import

2022-10-24 19:41:38 +02:00
commit 3822a0a7e6
11 changed files with 1030 additions and 0 deletions
--- a/pll.c
+++ b/pll.c
@@ -0,0 +1,20 @@
+#include <stdint.h>
+
+#ifdef __XC16
+#include <libq.h>
+#include <dsp.h>
+#endif
+
+#include "demodulator.h"
+
+int pll_frequency_servo(fractional frequency_error) {
+   fractional frequency_servo_feedback;
+
+   if (_Q15abs(frequency_error) < 1) frequency_servo_feedback = frequency_error;
+   else {
+      frequency_servo_feedback =  _Q15shr(frequency_error, 6);
+   }
+
+   return frequency_servo_feedback;
+}
+