luatos-soc-air105/bsp/air105/hal/core_adc.c

/*
 * 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