Files
proxmark3/common_arm/rssi/rssi_hw_at91.h
T

57 lines
1.9 KiB
C

#ifndef _ADC_RSSI_HW_AT91_H
#define _ADC_RSSI_HW_AT91_H
#include "at91sam7s512.h"
#include "proxmark3_arm.h"
#if defined RDV4 || defined ICOPYX
// ADC Vref = 3300mV, and an (10000k+240k):240k voltage divider on the LF input can measure voltages up to 140800 mV
#define MAX_ADC_HF_VOLTAGE 140800
#else
// ADC Vref = 3300mV, and an (10M+1M):1M voltage divider on the HF input can measure voltages up to 36300 mV
#define MAX_ADC_HF_VOLTAGE 36300
#endif
// ADC Vref = 3300mV, (240k-10M):240k voltage divider, 140800 mV
#define MAX_ADC_LF_VOLTAGE 140800
STATIC_FORCE_INLINE void AdcRssiConversionStart(void) {
AT91C_BASE_ADC->ADC_CR = AT91C_ADC_START;
}
STATIC_FORCE_INLINE bool AdcRssiDataReady(adc_rssi_ch_t ch) {
if (ch == ADC_RSSI_CH_HF) {
return AT91C_BASE_ADC->ADC_SR & ADC_END_OF_CONVERSION(ADC_CHAN_HF);
}
return AT91C_BASE_ADC->ADC_SR & ADC_END_OF_CONVERSION(ADC_CHAN_LF);
}
STATIC_FORCE_INLINE uint32_t AdcRssiDataRead(adc_rssi_ch_t ch) {
if (ch == ADC_RSSI_CH_HF) {
return AT91C_BASE_ADC->ADC_CDR[ADC_CHAN_HF] & 0x3FF;
}
return AT91C_BASE_ADC->ADC_CDR[ADC_CHAN_LF] & 0x3FF;
}
STATIC_FORCE_INLINE uint32_t AdcRssiDataToMilliVolt(uint16_t data, adc_rssi_ch_t ch) {
if (ch == ADC_RSSI_CH_HF) {
return ((uint32_t)data * MAX_ADC_HF_VOLTAGE) >> 10;
}
return ((uint32_t)data * MAX_ADC_LF_VOLTAGE) >> 10;
}
STATIC_FORCE_INLINE uint32_t AdcRssiAvgToMilliVolt(adc_rssi_ch_t ch) {
/*
* voltage = (sum_32 / 32) * (MAX_ADC_HF_VOLTAGE / 1024)
* = (sum_32 * MAX_ADC_HF_VOLTAGE) / (32 * 1024)
* = (sum_32 * MAX_ADC_HF_VOLTAGE) / 32768
* = (sum_32 * MAX_ADC_HF_VOLTAGE) >> 15
*/
if (ch == ADC_RSSI_CH_HF) {
return (MAX_ADC_HF_VOLTAGE * AdcRssiSum(ADC_RSSI_CH_HF, 32)) >> 15;
}
// Moving one bit to the right in advance is to avoid the risk of multiplication overflow.
return (MAX_ADC_LF_VOLTAGE * (AdcRssiSum(ADC_RSSI_CH_LF, 32) >> 1)) >> 14;
}
#endif