wen/luban-lite-t3e-pro
1
0
Fork 0
mirror of https://gitee.com/Vancouver2017/luban-lite-t3e-pro.git synced 2025-12-16 11:28:54 +00:00
Code Issues Packages Projects Releases Wiki Activity

V1.0.5

Browse Source
This commit is contained in:
刘可亮
2024-06-04 19:00:30 +08:00
parent 990c72f5be
commit 0a13af6a1d
1668 changed files with 342810 additions and 37726 deletions
Download Patch File Download Diff File Expand all files Collapse all files

132
bsp/examples/test-gpai/test_gpai.c
View File

@@ -15,12 +15,14 @@
#include "rtdevice.h"
#include "aic_core.h"
#include "aic_log.h"
#include "hal_gpai.h"
/* Global macro and variables */
#define AIC_GPAI_NAME "gpai"
/* The default voltages are set to D21x->3.0V, D31x、D12x->2.5V */
#define AIC_GPAI_DEFAULT_VOLTAGE 3
#define AIC_GPAI_VOLTAGE_ACCURACY 10000
#define AIC_GPAI_FIFO_MAX_DEPTH 32
static rt_adc_device_t gpai_dev;
static const char sopts[] = "c:t:n:h";
@@ -33,6 +35,8 @@ static const struct option lopts[] = {
};
static int g_sample_num = -1;
static u32 g_cal_param;
static rt_sem_t g_gpai_sem = RT_NULL;
/* Functions */
static void cmd_gpai_usage(char *program)
@@ -48,49 +52,97 @@ static void cmd_gpai_usage(char *program)
printf("Example: %s -c 4 -n 100 -t 3\n", program);
}
static int gpai_get_adc(long chan, float def_voltage)
static void gpai_irq_callback(void *arg)
{
rt_sem_release(g_gpai_sem);
}
static int gpai_get_adc_period(struct aic_gpai_ch_info ch_info,
float def_voltage)
{
int val;
int cnt = 0;
u32 cal_param;
int voltage = 0;
int last_irq_count = 0;
int current_irq_count = 0;
rt_base_t level;
int scale = AIC_GPAI_VOLTAGE_ACCURACY;
int sample_cnt = g_sample_num;
struct aic_gpai_irq_info irq_info;
int ch = ch_info.chan_id;
cal_param = hal_adcim_auto_calibration();
g_cal_param = hal_adcim_auto_calibration();
irq_info.chan_id = ch;
irq_info.callback = gpai_irq_callback;
irq_info.callback_param = NULL;
if (!g_gpai_sem)
g_gpai_sem = rt_sem_create("gpai_period_sem", 0, RT_IPC_FLAG_FIFO);
rt_adc_control(gpai_dev, RT_ADC_CMD_IRQ_CALLBACK, &irq_info);
rt_adc_enable(gpai_dev, ch);
while (cnt < sample_cnt) {
if (rt_sem_take(g_gpai_sem, RT_WAITING_FOREVER)!=RT_EOK)
break;
level = rt_hw_interrupt_disable();
rt_adc_control(gpai_dev, RT_ADC_CMD_GET_CH_INFO, (void *)&ch_info);
rt_hw_interrupt_enable(level);
for (int i = 0; i < ch_info.fifo_valid_cnt; i++) {
rt_kprintf("[%d] GPAI ch%d: %d\n", cnt, ch, ch_info.adc_values[i]);
if (ch_info.adc_values[i]) {
voltage = hal_adcim_adc2voltage(ch_info.adc_values[i],
g_cal_param,
AIC_GPAI_VOLTAGE_ACCURACY,
def_voltage);
rt_kprintf("GPAI voltage:%d.%04d v\n", voltage / scale,
voltage % scale);
}
cnt++;
}
}
rt_adc_disable(gpai_dev, ch);
return voltage;
}
static int gpai_get_adc_single(struct aic_gpai_ch_info ch_info,
float def_voltage)
{
int cnt = 0;
int voltage = 0;
int scale = AIC_GPAI_VOLTAGE_ACCURACY;
int sample_cnt = g_sample_num;
int adc_val;
int ch = ch_info.chan_id;
g_cal_param = hal_adcim_auto_calibration();
gpai_dev = (rt_adc_device_t)rt_device_find(AIC_GPAI_NAME);
if (!gpai_dev) {
rt_kprintf("Failed to open %s device\n", AIC_GPAI_NAME);
return -RT_ERROR;
}
rt_adc_enable(gpai_dev, chan);
while(sample_cnt) {
while(1) {
current_irq_count = rt_adc_control(gpai_dev, RT_ADC_CMD_IRQ_COUNT,
(void *)chan);
if (current_irq_count != last_irq_count) {
last_irq_count = current_irq_count;
break;
}
}
rt_adc_enable(gpai_dev, ch);
cnt++;
val = rt_adc_read(gpai_dev, chan);
rt_kprintf("[%d] GPAI ch%d: %d\n", cnt, chan, val);
while (cnt < sample_cnt) {
rt_adc_control(gpai_dev, RT_ADC_CMD_GET_CH_INFO, (void *)&ch_info);
if (val) {
voltage = hal_adcim_adc2voltage(val, cal_param,
aicos_msleep(10);
adc_val = ch_info.adc_values[0];
rt_kprintf("[%d] GPAI ch%d: %d\n", cnt, ch, adc_val);
if (adc_val) {
voltage = hal_adcim_adc2voltage(adc_val, g_cal_param,
AIC_GPAI_VOLTAGE_ACCURACY,
def_voltage);
rt_kprintf("GPAI ch%d-voltage:%d.%04d v\n", chan, voltage / scale,
rt_kprintf("GPAI voltage:%d.%04d v\n", voltage / scale,
voltage % scale);
}
sample_cnt--;
cnt++;
}
rt_adc_disable(gpai_dev, chan);
rt_adc_disable(gpai_dev, ch);
return voltage;
}
@@ -98,9 +150,11 @@ static int gpai_get_adc(long chan, float def_voltage)
static int cmd_test_gpai(int argc, char **argv)
{
int c;
int ret;
u32 ch = 0;
float def_voltage = AIC_GPAI_DEFAULT_VOLTAGE;
int voltage = -1;
struct aic_gpai_ch_info ch_info = {0};
if (argc < 2) {
cmd_gpai_usage(argv[0]);
@@ -141,7 +195,35 @@ static int cmd_test_gpai(int argc, char **argv)
rt_kprintf("Please set the number of samples\n");
return voltage;
}
voltage = gpai_get_adc(ch, def_voltage);
gpai_dev = (rt_adc_device_t)rt_device_find(AIC_GPAI_NAME);
if (!gpai_dev) {
rt_kprintf("Failed to open %s device\n", AIC_GPAI_NAME);
return -RT_ERROR;
}
ch_info.chan_id = ch;
ret = rt_adc_control(gpai_dev, RT_ADC_CMD_GET_MODE, (void *)&ch_info);
if (ret) {
rt_kprintf("Failed to get GPAI mode\n");
return -RT_ERROR;
}
switch (ch_info.mode) {
case AIC_GPAI_MODE_SINGLE:
rt_kprintf("Starting gpai single mode\n");
voltage = gpai_get_adc_single(ch_info, def_voltage);
break;
case AIC_GPAI_MODE_PERIOD:
rt_kprintf("Starting gpai period mode\n");
voltage = gpai_get_adc_period(ch_info, def_voltage);
break;
default:
rt_kprintf("Unknown mode: %#x\n");
break;
}
return voltage;
}