From 74b8178676482da9cb6c2bb4dd8c9dff3cdf712a Mon Sep 17 00:00:00 2001
From: Daniel H <tudbut@tudbut.de>
Date: Sun, 30 Apr 2023 13:33:00 +0200
Subject: [PATCH] Create pico-am.ino

---
 pico-am.ino | 122 ++++++++++++++++++++++++++++++++++++++++++++++++++++
 1 file changed, 122 insertions(+)
 create mode 100644 pico-am.ino

diff --git a/pico-am.ino b/pico-am.ino
new file mode 100644
index 0000000..05dbda1
--- /dev/null
+++ b/pico-am.ino
@@ -0,0 +1,122 @@
+// You will need to install RP2040_PWM in the Arduino IDE first!
+
+
+#define F_CPU 204000000
+
+
+#include "RP2040_PWM.h"
+#include "hardware/pll.h"
+#include "hardware/clocks.h"
+
+//////////////////////////////////// begin clock code
+#include "hardware/pll.h"
+#include "hardware/clocks.h"
+
+void set_sys_clock_pll(uint32_t vco_freq, uint post_div1, uint post_div2) {
+  if (!running_on_fpga()) {
+    clock_configure(clk_sys,
+                    CLOCKS_CLK_SYS_CTRL_SRC_VALUE_CLKSRC_CLK_SYS_AUX,
+                    CLOCKS_CLK_SYS_CTRL_AUXSRC_VALUE_CLKSRC_PLL_USB,
+                    48 * MHZ,
+                    48 * MHZ);
+
+    pll_init(pll_sys, 1, vco_freq, post_div1, post_div2);
+    uint32_t freq = vco_freq / (post_div1 * post_div2);
+
+    // Configure clocks
+    // CLK_REF = XOSC (12MHz) / 1 = 12MHz
+    clock_configure(clk_ref,
+                    CLOCKS_CLK_REF_CTRL_SRC_VALUE_XOSC_CLKSRC,
+                    0,  // No aux mux
+                    12 * MHZ,
+                    12 * MHZ);
+
+    // CLK SYS = PLL SYS (125MHz) / 1 = 125MHz
+    clock_configure(clk_sys,
+                    CLOCKS_CLK_SYS_CTRL_SRC_VALUE_CLKSRC_CLK_SYS_AUX,
+                    CLOCKS_CLK_SYS_CTRL_AUXSRC_VALUE_CLKSRC_PLL_SYS,
+                    freq, freq);
+
+    clock_configure(clk_peri,
+                    0,  // Only AUX mux on ADC
+                    CLOCKS_CLK_PERI_CTRL_AUXSRC_VALUE_CLKSRC_PLL_USB,
+                    48 * MHZ,
+                    48 * MHZ);
+  }
+}
+bool check_sys_clock_khz(uint32_t freq_khz, uint *vco_out, uint *postdiv1_out, uint *postdiv_out) {
+  uint crystal_freq_khz = clock_get_hz(clk_ref) / 1000;
+  for (uint fbdiv = 320; fbdiv >= 16; fbdiv--) {
+    uint vco = fbdiv * crystal_freq_khz;
+    if (vco < 400000 || vco > 1600000) continue;
+    for (uint postdiv1 = 7; postdiv1 >= 1; postdiv1--) {
+      for (uint postdiv2 = postdiv1; postdiv2 >= 1; postdiv2--) {
+        uint out = vco / (postdiv1 * postdiv2);
+        if (out == freq_khz && !(vco % (postdiv1 * postdiv2))) {
+          *vco_out = vco * 1000;
+          *postdiv1_out = postdiv1;
+          *postdiv_out = postdiv2;
+          return true;
+        }
+      }
+    }
+  }
+  return false;
+}
+static inline bool set_sys_clock_khz(uint32_t freq_khz, bool required) {
+  uint vco, postdiv1, postdiv2;
+  if (check_sys_clock_khz(freq_khz, &vco, &postdiv1, &postdiv2)) {
+    set_sys_clock_pll(vco, postdiv1, postdiv2);
+    return true;
+  } else if (required) {
+    panic("System clock of %u kHz cannot be exactly achieved", freq_khz);
+  }
+  return false;
+}
+//////////////////////////////////// end clock code
+
+RP2040_PWM* pwm;
+RP2040_PWM* led;
+
+void setup() {
+  Serial.begin(9600);
+  set_sys_clock_khz(204000, true);
+  pwm = new RP2040_PWM(15, 1557000, 0);
+  pwm->enablePWM();
+  uint16_t PWM_TOP   = pwm->get_TOP();
+  uint16_t PWM_DIV   = pwm->get_DIV();
+  uint16_t PWM_Level = 0;
+  // setPWM_manual(uint8_t pin, uint16_t top, uint8_t div, uint16_t level, bool phaseCorrect = false)
+  pwm->setPWM_manual(15, PWM_TOP, PWM_DIV, PWM_Level, true);
+  led = new RP2040_PWM(LED_BUILTIN, 1557000, 100);
+  led->enablePWM();
+  PWM_TOP   = led->get_TOP();
+  PWM_DIV   = led->get_DIV();
+  PWM_Level = 65535;
+  // setPWM_manual(uint8_t pin, uint16_t top, uint8_t div, uint16_t level, bool phaseCorrect = false)
+  led->setPWM_manual(LED_BUILTIN, PWM_TOP, PWM_DIV, PWM_Level, false);
+  Serial.println(pwm->get_freq_CPU());
+  Serial.println(pwm->getActualFreq());
+  delay(200);
+}
+
+//long n = 0;
+//float m = 0;
+
+void loop() {
+  float v = ((float) analogRead(26) / 4096.0 * 7 * 100.0); 
+  pwm->setPWM_DCPercentage_manual(15, v);
+  v *= 2;
+  led->setPWM_DCPercentage_manual(LED_BUILTIN, v);
+  //n = n + 1;
+  //if(m < v) { m = v; }
+  //if(n % 100000 == 0) {
+    //Serial.print(n);
+    //Serial.println(": ");
+    //Serial.println(m);
+    //m = 0;
+  //}
+}
+
+
+