|
35 | 35 | uint64_t next_start_tick_ms = 0;
|
36 | 36 | uint32_t next_start_tick_us = 1000;
|
37 | 37 |
|
| 38 | +//sysclock divisors |
| 39 | +#define MAGIC_800_INT 900000 // ~1.11 us -> 1.2 field |
| 40 | +#define MAGIC_800_T0H 2800000 // ~0.36 us -> 0.44 field |
| 41 | +#define MAGIC_800_T1H 1350000 // ~0.74 us -> 0.84 field |
| 42 | + |
38 | 43 | void common_hal_neopixel_write (const digitalio_digitalinout_obj_t* digitalinout, uint8_t *pixels,
|
39 | 44 | uint32_t numBytes) {
|
40 | 45 | uint8_t *p = pixels, *end = p + numBytes, pix = *p++, mask = 0x80;
|
41 | 46 | uint32_t start = 0;
|
42 | 47 | uint32_t cyc = 0;
|
43 | 48 |
|
44 | 49 | //assumes 800_000Hz frequency
|
| 50 | + //Theoretical values here are 800_000 -> 1.25us, 2500000->0.4us, 1250000->0.8us |
| 51 | + //But they don't work, possibly due to bad optimization? Use tested magic values instead |
45 | 52 | uint32_t sys_freq = HAL_RCC_GetSysClockFreq();
|
46 |
| - uint32_t interval = sys_freq/800000; // cycles per interval (1.25 us). 210@168MHz |
47 |
| - uint32_t t0 = interval - (sys_freq/2500000); // 0.4 us |
48 |
| - uint32_t t1 = interval - (sys_freq/1250000); // 0.8 us |
| 53 | + uint32_t interval = sys_freq/MAGIC_800_INT; |
| 54 | + uint32_t t0 = (sys_freq/MAGIC_800_T0H); |
| 55 | + uint32_t t1 = (sys_freq/MAGIC_800_T1H); |
49 | 56 |
|
50 | 57 | // This must be called while interrupts are on in case we're waiting for a
|
51 | 58 | // future ms tick.
|
52 | 59 | wait_until(next_start_tick_ms, next_start_tick_us);
|
53 | 60 |
|
| 61 | + GPIO_TypeDef * p_port = pin_port(digitalinout->pin->port); |
| 62 | + uint32_t p_mask = pin_mask(digitalinout->pin->number); |
| 63 | + |
54 | 64 | __disable_irq();
|
55 | 65 | // Enable DWT in debug core. Useable when interrupts disabled, as opposed to Systick->VAL
|
56 |
| - //ITM->LAR = 0xC5ACCE55; //is this required? |
| 66 | + //ITM->LAR = 0xC5ACCE55; //this should be required but isn't |
57 | 67 | CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
|
58 | 68 | DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
|
59 | 69 | DWT->CYCCNT = 0;
|
60 | 70 |
|
61 |
| - GPIO_TypeDef * p_port = pin_port(digitalinout->pin->port); |
62 |
| - uint32_t p_mask = pin_mask(digitalinout->pin->number); |
63 |
| - |
64 | 71 | for(;;) {
|
| 72 | + start = DWT->CYCCNT; |
65 | 73 | LL_GPIO_SetOutputPin(p_port, p_mask);
|
66 | 74 | cyc = (pix & mask) ? t1 : t0;
|
67 |
| - start = DWT->CYCCNT; |
68 | 75 | while(DWT->CYCCNT - start < cyc);
|
69 | 76 | LL_GPIO_ResetOutputPin(p_port, p_mask);
|
70 |
| - if(!(mask >>= 1)) { //max has shifted all the way |
| 77 | + if(!(mask >>= 1)) { |
71 | 78 | if(p >= end) break;
|
72 | 79 | pix = *p++;
|
73 | 80 | mask = 0x80;
|
|
0 commit comments