116 lines
3.6 KiB
C++
116 lines
3.6 KiB
C++
// You will need to install RP2040_PWM in the Arduino IDE first!
|
|
|
|
|
|
#define F_CPU 204000000
|
|
|
|
|
|
#include "RP2040_PWM.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 * 6 * 100.0 + 10);
|
|
pwm->setPWM_DCPercentage_manual(15, v);
|
|
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;
|
|
//}
|
|
}
|