|
| 1 | +//go:build stm32h7 |
| 2 | + |
| 3 | +package machine |
| 4 | + |
| 5 | +import ( |
| 6 | + "device/arm" |
| 7 | + "device/stm32" |
| 8 | +) |
| 9 | + |
| 10 | +// InitADC initializes the registers needed for ADC1 and ADC3. |
| 11 | +func InitADC() { |
| 12 | + // 1. Enable ADC bus clocks |
| 13 | + stm32.RCC.AHB1ENR.SetBits(stm32.RCC_AHB1ENR_ADC12EN) |
| 14 | + stm32.RCC.AHB4ENR.SetBits(stm32.RCC_AHB4ENR_ADC3EN) |
| 15 | + |
| 16 | + // 2. Configure ADC clock mode (Async from kernel clock) |
| 17 | + // CCR is at offset 0x308 from ADC base. |
| 18 | + stm32.ADC12_Common.CR.ReplaceBits(0x0, 0x3, 16) // CKMODE = 00 |
| 19 | + stm32.ADC3_Common.CR.ReplaceBits(0x0, 0x3, 16) // CKMODE = 00 |
| 20 | + |
| 21 | + // 3. Exit deep power-down mode |
| 22 | + stm32.ADC1.CR.ClearBits(stm32.ADC_CR_DEEPPWD) |
| 23 | + stm32.ADC3.CR.ClearBits(stm32.ADC_CR_DEEPPWD) |
| 24 | + |
| 25 | + // 4. Enable voltage regulators |
| 26 | + stm32.ADC1.CR.SetBits(stm32.ADC_CR_ADVREGEN) |
| 27 | + stm32.ADC3.CR.SetBits(stm32.ADC_CR_ADVREGEN) |
| 28 | + // Wait for T_ADCVREG_STUP (min 10us). The nop keeps the compiler from |
| 29 | + // eliminating the loop as free of side effects. |
| 30 | + for i := 0; i < 10000; i++ { |
| 31 | + arm.Asm("nop") |
| 32 | + } |
| 33 | + |
| 34 | + // Set BOOST[1:0]=0b11 for ADC kernel clock >25MHz (RM0433 §25.4.3 Table 121). |
| 35 | + // The kernel clock is 80MHz (PLL2_P), so BOOST must be enabled. |
| 36 | + stm32.ADC1.CR.ReplaceBits(0b11, 0x3, stm32.ADC_CR_BOOST_Pos) |
| 37 | + stm32.ADC3.CR.ReplaceBits(0b11, 0x3, stm32.ADC_CR_BOOST_Pos) |
| 38 | + |
| 39 | + // 5. Calibration |
| 40 | + // ADC1 |
| 41 | + stm32.ADC1.CR.SetBits(stm32.ADC_CR_ADCAL | stm32.ADC_CR_ADCALLIN) |
| 42 | + for stm32.ADC1.CR.HasBits(stm32.ADC_CR_ADCAL) { |
| 43 | + } |
| 44 | + // ADC3 |
| 45 | + stm32.ADC3.CR.SetBits(stm32.ADC_CR_ADCAL | stm32.ADC_CR_ADCALLIN) |
| 46 | + for stm32.ADC3.CR.HasBits(stm32.ADC_CR_ADCAL) { |
| 47 | + } |
| 48 | + |
| 49 | + // 6. Enable ADCs |
| 50 | + // ADC1 |
| 51 | + stm32.ADC1.ISR.SetBits(stm32.ADC_ISR_ADRDY) // Clear ADRDY by writing 1 |
| 52 | + stm32.ADC1.CR.SetBits(stm32.ADC_CR_ADEN) |
| 53 | + for !stm32.ADC1.ISR.HasBits(stm32.ADC_ISR_ADRDY) { |
| 54 | + } |
| 55 | + // ADC3 |
| 56 | + stm32.ADC3.ISR.SetBits(stm32.ADC_ISR_ADRDY) // Clear ADRDY by writing 1 |
| 57 | + stm32.ADC3.CR.SetBits(stm32.ADC_CR_ADEN) |
| 58 | + for !stm32.ADC3.ISR.HasBits(stm32.ADC_ISR_ADRDY) { |
| 59 | + } |
| 60 | + |
| 61 | + // 7. Configure resolution (16-bit) |
| 62 | + // RES[2:0] is at bits 4:2 in CFGR. 000: 16-bit. |
| 63 | + stm32.ADC1.CFGR.ReplaceBits(0x0, 0x7, 2) |
| 64 | + stm32.ADC3.CFGR.ReplaceBits(0x0, 0x7, 2) |
| 65 | +} |
| 66 | + |
| 67 | +// Configure configures an ADC pin to be able to read analog data. |
| 68 | +func (a ADC) Configure(config ADCConfig) { |
| 69 | + a.Pin.Configure(PinConfig{Mode: PinInputAnalog}) |
| 70 | + |
| 71 | + // Set sampling time. |
| 72 | + // H7 has SMPR1 (channels 0-9) and SMPR2 (channels 10-19). |
| 73 | + // Each channel has 3 bits. |
| 74 | + ch := a.getChannel() |
| 75 | + adc, _ := a.getPeripheral() |
| 76 | + const smpVal = 0x2 // 8.5 cycles |
| 77 | + if ch <= 9 { |
| 78 | + adc.SMPR1.ReplaceBits(uint32(smpVal), 0x7, uint8(ch)*3) |
| 79 | + } else { |
| 80 | + adc.SMPR2.ReplaceBits(uint32(smpVal), 0x7, uint8(ch-10)*3) |
| 81 | + } |
| 82 | +} |
| 83 | + |
| 84 | +// Get returns the current value of an ADC pin in the range 0..0xffff. |
| 85 | +func (a ADC) Get() uint16 { |
| 86 | + ch := uint32(a.getChannel()) |
| 87 | + adc, ok := a.getPeripheral() |
| 88 | + if !ok { |
| 89 | + return 0 |
| 90 | + } |
| 91 | + |
| 92 | + // Select channel (PCSEL register) |
| 93 | + // Refer to RM0433 §25.4.12: Only one PCSELx bit must be set at a time. |
| 94 | + adc.PCSEL.Set(1 << ch) |
| 95 | + |
| 96 | + // Set rank 1 to channel |
| 97 | + // SQ1[4:0] at bits 10:6. L[3:0] at bits 3:0. |
| 98 | + adc.SQR1.ReplaceBits(ch, 0x1F, 6) |
| 99 | + adc.SQR1.ReplaceBits(0x0, 0xF, 0) // L=0 (1 conversion) |
| 100 | + |
| 101 | + // Start conversion |
| 102 | + adc.CR.SetBits(stm32.ADC_CR_ADSTART) |
| 103 | + |
| 104 | + // Wait for end of conversion |
| 105 | + for !adc.ISR.HasBits(stm32.ADC_ISR_EOC) { |
| 106 | + } |
| 107 | + |
| 108 | + // Read 16-bit result |
| 109 | + result := uint16(adc.DR.Get()) |
| 110 | + |
| 111 | + // Clear EOC |
| 112 | + adc.ISR.SetBits(stm32.ADC_ISR_EOC) |
| 113 | + |
| 114 | + // Deselect channel |
| 115 | + adc.PCSEL.Set(0) |
| 116 | + |
| 117 | + return result |
| 118 | +} |
| 119 | + |
| 120 | +func (a ADC) getPeripheral() (*stm32.ADC_Type, bool) { |
| 121 | + switch a.Pin { |
| 122 | + case PF3, PF4, PF5, PF6, PF7, PF8, PF9, PF10: |
| 123 | + return stm32.ADC3, true |
| 124 | + default: |
| 125 | + // Assume ADC1 for PA/PB/PC pins |
| 126 | + return stm32.ADC1, true |
| 127 | + } |
| 128 | +} |
| 129 | + |
| 130 | +// getChannel returns the ADC channel number for a given GPIO pin. |
| 131 | +// Mapping for STM32H743 per RM0433 and DS12110. |
| 132 | +func (a ADC) getChannel() uint8 { |
| 133 | + switch a.Pin { |
| 134 | + case PA0: |
| 135 | + return 16 |
| 136 | + case PA1: |
| 137 | + return 17 |
| 138 | + case PA2: |
| 139 | + return 14 |
| 140 | + case PA3: |
| 141 | + return 15 |
| 142 | + case PA4: |
| 143 | + return 18 |
| 144 | + case PA5: |
| 145 | + return 19 |
| 146 | + case PA6: |
| 147 | + return 3 |
| 148 | + case PA7: |
| 149 | + return 7 |
| 150 | + case PB0: |
| 151 | + return 9 |
| 152 | + case PB1: |
| 153 | + return 5 |
| 154 | + case PC0: |
| 155 | + return 10 |
| 156 | + case PC1: |
| 157 | + return 11 |
| 158 | + case PC2: |
| 159 | + return 12 |
| 160 | + case PC3: |
| 161 | + return 13 |
| 162 | + case PC4: |
| 163 | + return 4 |
| 164 | + case PC5: |
| 165 | + return 8 |
| 166 | + case PF3: |
| 167 | + return 5 |
| 168 | + case PF4: |
| 169 | + return 9 |
| 170 | + case PF5: |
| 171 | + return 4 |
| 172 | + case PF6: |
| 173 | + return 8 |
| 174 | + case PF7: |
| 175 | + return 3 |
| 176 | + case PF8: |
| 177 | + return 7 |
| 178 | + case PF9: |
| 179 | + return 2 |
| 180 | + case PF10: |
| 181 | + return 6 |
| 182 | + } |
| 183 | + return 0 |
| 184 | +} |
0 commit comments