/* * Copyright (c) 2022 OpenLuat & AirM2M * * Permission is hereby granted, free of charge, to any person obtaining a copy of * this software and associated documentation files (the "Software"), to deal in * the Software without restriction, including without limitation the rights to * use, copy, modify, merge, publish, distribute, sublicense, and/or sell copies of * the Software, and to permit persons to whom the Software is furnished to do so, * subject to the following conditions: * * The above copyright notice and this permission notice shall be included in all * copies or substantial portions of the Software. * * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, FITNESS * FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR * COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER * IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. */ #include "user.h" #define SAMPLE_PER_CH (14) #if 0 typedef struct { uint32_t Data[SAMPLE_PER_CH]; }Channel_DataStruct; typedef struct { Channel_DataStruct ChannelData[ADC_CHANNEL_MAX]; uint32_t Ctrl; uint8_t Enable[ADC_CHANNEL_MAX]; uint8_t CurChannel; }ADC_CtrlStruct; static ADC_CtrlStruct prvADC; static void __FUNC_IN_RAM__ ADC_IrqHandle(int32_t IrqLine, void *pData) { int i; uint8_t NextChannel; ADC0->ADC_CR1 = 0; { for(i = 0; i < SAMPLE_PER_CH; i++) { prvADC.ChannelData[prvADC.CurChannel].Data[i] = ADC0->ADC_DATA & 0x0fff; } if (prvADC.CurChannel == (ADC_CHANNEL_MAX - 1)) { NextChannel = 0; } else { NextChannel = prvADC.CurChannel + 1; } prvADC.CurChannel = 0; for(i = NextChannel; i < ADC_CHANNEL_MAX; i++) { if (prvADC.Enable[i]) { prvADC.CurChannel = i; break; } } ADC0->ADC_FIFO = 3; ADC0->ADC_CR1 = 0x060 | prvADC.Ctrl | prvADC.CurChannel; } } void ADC_GlobalInit(void) { int i; // for(i = 0; i < ADC_CHANNEL_MAX;i++) // { // prvADC.Enable[i] = 1; // } prvADC.Enable[0] = 1; prvADC.Ctrl = 2 << 3; ADC0->ADC_FIFO_THR = SAMPLE_PER_CH - 1; ADC0->ADC_FIFO = 3; ADC0->ADC_CR2 &= ~(1 << 14); ADC0->ADC_CR2 &= ~(1 << 13); ISR_SetHandler(ADC0_IRQn, ADC_IrqHandle, NULL); #ifdef __BUILD_OS___ ISR_SetPriority(ADC0_IRQn, IRQ_LOWEST_PRIORITY); #else ISR_SetPriority(ADC0_IRQn, 6); #endif ISR_OnOff(ADC0_IRQn, 1); ADC0->ADC_CR1 = 0x060 | prvADC.Ctrl | prvADC.CurChannel; } void ADC_SetSpeed(uint8_t Level) { prvADC.Ctrl = Level << 3; } void ADC_IntelResistance(uint8_t OnOff) { if (OnOff) { ADC0->ADC_CR2 |= (1 << 13); } else { ADC0->ADC_CR2 &= ~(1 << 13); } } void ADC_ChannelOnOff(uint8_t Channel, uint8_t OnOff) { if (!Channel) return; int i; ISR_OnOff(ADC0_IRQn, 0); prvADC.Enable[Channel] = OnOff; ISR_OnOff(ADC0_IRQn, 1); } uint32_t ADC_GetChannelValue(uint8_t Channel) { uint32_t total= 0; uint32_t value = 0; uint32_t max = 0; uint32_t min = 0xffff; uint32_t i; uint32_t Data[SAMPLE_PER_CH]; ISR_OnOff(ADC0_IRQn, 0); memcpy(&Data[10], &prvADC.ChannelData[Channel].Data[10], (SAMPLE_PER_CH - 10) * sizeof(uint32_t)); ISR_OnOff(ADC0_IRQn, 1); for (i = 10; i < SAMPLE_PER_CH; i++) { // DBG("%d,%d", i, Data[i]); value = Data[i]; if(max < value) max = value; if(min > value) min = value; total += value; } return ((total - max) -min)/(SAMPLE_PER_CH-12); } uint32_t ADC_GetChannelValueBlock(uint8_t Channel) { } #else typedef struct { uint32_t Data[SAMPLE_PER_CH]; volatile uint8_t Done; }ADC_CtrlStruct; static ADC_CtrlStruct prvADC; static void ADC_IrqHandle(int32_t IrqLine, void *pData) { int i; ADC0->ADC_CR1 = 0; prvADC.Done = 1; for(i = 0; i < SAMPLE_PER_CH; i++) { prvADC.Data[i] = ADC0->ADC_DATA & 0x0fff; } ADC0->ADC_FIFO = 3; } void ADC_GlobalInit(void) { int i; ADC0->ADC_FIFO_THR = SAMPLE_PER_CH - 1; ADC0->ADC_FIFO = 3; ADC0->ADC_CR2 &= ~(1 << 14); ADC0->ADC_CR2 &= ~(1 << 13); ADC0->ADC_CR1 = 0; #if 0 ISR_SetHandler(ADC0_IRQn, ADC_IrqHandle, NULL); #ifdef __BUILD_OS___ ISR_SetPriority(ADC0_IRQn, IRQ_LOWEST_PRIORITY - 1); #else ISR_SetPriority(ADC0_IRQn, 6); #endif #endif ISR_OnOff(ADC0_IRQn, 0); // ADC_IntelResistance(1); } void ADC_IntelResistance(uint8_t OnOff) { if (OnOff) { ADC0->ADC_CR2 |= (1 << 13); } else { ADC0->ADC_CR2 &= ~(1 << 13); } } void ADC_ChannelOnOff(uint8_t Channel, uint8_t OnOff) { } uint32_t ADC_GetChannelValue(uint8_t Channel, uint32_t *Vol) { // uint32_t total= 0; uint32_t value = 0; // uint32_t max = 0; // uint32_t min = 0x0fff; uint32_t i; ADC0->ADC_FIFO = 3; while(ADC0->ADC_FIFO & (BIT(1))) {;} // prvADC.Done = 0; // ISR_OnOff(ADC0_IRQn, 1); memset(prvADC.Data, 0, sizeof(prvADC.Data)); ADC0->ADC_CR1 = 0x040 | Channel; while(!(ADC0->ADC_SR & BIT(0))){;} ADC0->ADC_CR1 = 0; // prvADC.Done = 1; for(i = 0; i < SAMPLE_PER_CH; i++) { prvADC.Data[i] = ADC0->ADC_DATA & 0x0fff; } ADC0->ADC_FIFO = 3; // for (i = 0; i < SAMPLE_PER_CH; i++) // { // DBG("%d,%d", i, prvADC.Data[i]); // } // for (i = 6; i < SAMPLE_PER_CH; i++) // { // // value = (prvADC.Data[i] & 0x3F) * 0.33 + prvADC.Data[i]; // DBG("%d,%d,%d", i, prvADC.Data[i], value); // if(max < value) // max = value; // if(min > value) // min = value; // total += value; // } ADC0->ADC_CR1 = Channel; // value = ((total - max) -min)/(SAMPLE_PER_CH-8); value = prvADC.Data[SAMPLE_PER_CH - 1]; if (!Channel) { *Vol = (value * 1880 * 14 / 5) >> 12; } else { if (ADC0->ADC_CR2 & (1 << 13)) { if (Channel != 6) { *Vol = (value * 3760) >> 12; } else { *Vol = (value * 470 * 1511 / 279) >> 11; } } else { *Vol = (value * 1880 / 4095); } } return value; } #ifdef __BUILD_APP__ INIT_HW_EXPORT(ADC_GlobalInit, "1"); #endif #endif