261 lines
7.7 KiB
C
261 lines
7.7 KiB
C
#include <platform_stdlib.h>
|
|
#include <platform_opts.h>
|
|
#include <gpio_api.h>
|
|
#include <analogout_api.h>
|
|
#include <analogin_api.h>
|
|
#include "log_service.h"
|
|
#include "atcmd_mp.h"
|
|
|
|
#if CONFIG_ATCMD_MP_EXT0
|
|
extern void fATM0(void *arg); // MP ext0 AT command
|
|
#endif
|
|
|
|
#if CONFIG_ATCMD_MP_EXT1
|
|
extern void fATM1(void *arg); // MP ext1 AT command
|
|
#endif
|
|
|
|
#if CONFIG_ATCMD_MP
|
|
//-------- AT MP commands ---------------------------------------------------------------
|
|
void fATMG(void *arg)
|
|
{
|
|
gpio_t gpio_test;
|
|
int argc = 0, val, cnts, i, write=0, data=0;
|
|
char *argv[MAX_ARGC] = {0}, port, num;
|
|
PinName pin = NC;
|
|
u32 tConfigDebugInfo = ConfigDebugInfo;
|
|
|
|
AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "[ATMG]: _AT_MP_GPIO_TEST_");
|
|
if(!arg){
|
|
AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "[ATMG] Usage: ATMG=w,PINNAMES(ex:A0B1C2...),VALUE(0/1)");
|
|
AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "[ATMG] Usage: ATMG=r,PINNAMES(ex:A0B1C2...)");
|
|
return;
|
|
}
|
|
|
|
argc = parse_param(arg, argv);
|
|
cnts = strlen(argv[2]);
|
|
if(cnts % 2) return;
|
|
cnts /= 2;
|
|
if(cnts == 0) return;
|
|
|
|
if(strcmp(argv[1], "w") == 0){
|
|
write = 1;
|
|
if(strcmp(argv[3], "1") == 0)
|
|
data = 1;
|
|
}
|
|
// Remove debug info massage
|
|
_AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "[ATMG] %s: ", argv[1]);
|
|
ConfigDebugInfo = 0;
|
|
for(i=0; i<(cnts*2); i+=2){
|
|
pin = NC;
|
|
port = argv[2][i];
|
|
num = argv[2][i+1];
|
|
if(port >= 'a' && port <= 'z')
|
|
port -= ('a' - 'A');
|
|
if(num >= 'a' && num <= 'z')
|
|
num -= ('a' - 'A');
|
|
switch(port){
|
|
case 'A':
|
|
switch(num){
|
|
case '0': pin = PA_0; break; case '1': pin = PA_1; break; case '2': pin = PA_2; break; case '3': pin = PA_3; break;
|
|
case '4': pin = PA_4; break; case '5': pin = PA_5; break; case '6': pin = PA_6; break; case '7': pin = PA_7; break;
|
|
}
|
|
break;
|
|
case 'B':
|
|
switch(num){
|
|
case '0': pin = PB_0; break; case '1': pin = PB_1; break; case '2': pin = PB_2; break; case '3': pin = PB_3; break;
|
|
case '4': pin = PB_4; break; case '5': pin = PB_5; break; case '6': pin = PB_6; break; case '7': pin = PB_7; break;
|
|
}
|
|
break;
|
|
case 'C':
|
|
switch(num){
|
|
case '0': pin = PC_0; break; case '1': pin = PC_1; break; case '2': pin = PC_2; break; case '3': pin = PC_3; break;
|
|
case '4': pin = PC_4; break; case '5': pin = PC_5; break; case '6': pin = PC_6; break; case '7': pin = PC_7; break;
|
|
case '8': pin = PC_8; break; case '9': pin = PC_9; break;
|
|
}
|
|
break;
|
|
case 'D':
|
|
switch(num){
|
|
case '0': pin = PD_0; break; case '1': pin = PD_1; break; case '2': pin = PD_2; break; case '3': pin = PD_3; break;
|
|
case '4': pin = PD_4; break; case '5': pin = PD_5; break; case '6': pin = PD_6; break; case '7': pin = PD_7; break;
|
|
case '8': pin = PD_8; break; case '9': pin = PD_9; break;
|
|
}
|
|
break;
|
|
case 'E':
|
|
switch(num){
|
|
case '0': pin = PE_0; break; case '1': pin = PE_1; break; case '2': pin = PE_2; break; case '3': pin = PE_3; break;
|
|
case '4': pin = PE_4; break; case '5': pin = PE_5; break; case '6': pin = PE_6; break; case '7': pin = PE_7; break;
|
|
case '8': pin = PE_8; break; case '9': pin = PE_9; break; case 'A': pin = PE_A; break;
|
|
}
|
|
break;
|
|
case 'F':
|
|
switch(num){
|
|
case '0': pin = PF_0; break; case '1': pin = PF_1; break; case '2': pin = PF_2; break; case '3': pin = PF_3; break;
|
|
case '4': pin = PF_4; break; case '5': pin = PF_5; break;
|
|
}
|
|
break;
|
|
case 'G':
|
|
switch(num){
|
|
case '0': pin = PG_0; break; case '1': pin = PG_1; break; case '2': pin = PG_2; break; case '3': pin = PG_3; break;
|
|
case '4': pin = PG_4; break; case '5': pin = PG_5; break; case '6': pin = PG_6; break; case '7': pin = PG_7; break;
|
|
}
|
|
break;
|
|
case 'H':
|
|
switch(num){
|
|
case '0': pin = PH_0; break; case '1': pin = PH_1; break; case '2': pin = PH_2; break; case '3': pin = PH_3; break;
|
|
case '4': pin = PH_4; break; case '5': pin = PH_5; break; case '6': pin = PH_6; break; case '7': pin = PH_7; break;
|
|
}
|
|
break;
|
|
case 'I':
|
|
switch(num){
|
|
case '0': pin = PI_0; break; case '1': pin = PI_1; break; case '2': pin = PI_2; break; case '3': pin = PI_3; break;
|
|
case '4': pin = PI_4; break; case '5': pin = PI_5; break; case '6': pin = PI_6; break; case '7': pin = PI_7; break;
|
|
}
|
|
break;
|
|
case 'J':
|
|
switch(num){
|
|
case '0': pin = PJ_0; break; case '1': pin = PJ_1; break; case '2': pin = PJ_2; break; case '3': pin = PJ_3; break;
|
|
case '4': pin = PJ_4; break; case '5': pin = PJ_5; break; case '6': pin = PJ_6; break;
|
|
}
|
|
break;
|
|
case 'K':
|
|
switch(num){
|
|
case '0': pin = PK_0; break; case '1': pin = PK_1; break; case '2': pin = PK_2; break; case '3': pin = PK_3; break;
|
|
case '4': pin = PK_4; break; case '5': pin = PK_5; break; case '6': pin = PK_6; break;
|
|
}
|
|
break;
|
|
}
|
|
if(pin == NC){
|
|
_AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "X,");
|
|
continue;
|
|
}
|
|
// Initial input control pin
|
|
gpio_init(&gpio_test, pin);
|
|
if(write){
|
|
gpio_dir(&gpio_test, PIN_OUTPUT); // Direction: Output
|
|
gpio_mode(&gpio_test, PullNone); // No pull
|
|
gpio_write(&gpio_test, data);
|
|
_AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "%d,", data);
|
|
}else{
|
|
gpio_dir(&gpio_test, PIN_INPUT); // Direction: Input
|
|
gpio_mode(&gpio_test, PullUp); // Pull-High
|
|
val = gpio_read(&gpio_test);
|
|
_AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "%d,", val);
|
|
}
|
|
}
|
|
_AT_DBG_MSG(AT_FLAG_GPIO, AT_DBG_ALWAYS, "\n");
|
|
// Recover debug info massage
|
|
ConfigDebugInfo = tConfigDebugInfo;
|
|
}
|
|
|
|
void fATMR(void *arg)
|
|
{
|
|
u32 idx;
|
|
|
|
AT_PRINTK("[ATMR]: _AT_MP_SDR_TEST_");
|
|
#ifdef CONFIG_SDR_EN
|
|
for (idx = 0; idx < 0x200000; idx = idx+4){
|
|
HAL_WRITE32(0x30000000, idx, 0x12345678);
|
|
if (HAL_READ32(0x30000000, idx) != 0x12345678) {
|
|
AT_PRINTK("[ATMR]: SDR test fail addr 0x08x, value 0x08%x",(0x30000000+idx),HAL_READ32(0x30000000, idx));
|
|
return;
|
|
}
|
|
}
|
|
AT_PRINTK("[ATMR]: SDR test success");
|
|
#endif
|
|
}
|
|
|
|
void fATMD(void *arg)
|
|
{
|
|
int argc = 0;
|
|
char *argv[MAX_ARGC] = {0}, *ptmp;;
|
|
u16 vdac;
|
|
dac_t dac0;
|
|
|
|
argc = parse_param(arg, argv);
|
|
#if CONFIG_BT
|
|
analogout_init(&dac0, DA_0);
|
|
#endif
|
|
HalDelayUs(50*1000); // delay 50 ms for DAC_CAP 10uF
|
|
vdac = strtoul(argv[1], &ptmp, 16);
|
|
// 0x800(0v) ~ 0x000(1.65v) ~ 0x7ff(3.3v)
|
|
#if CONFIG_BT
|
|
analogout_write_u16(&dac0, vdac);
|
|
#endif
|
|
AT_PRINTK("[ATMD]: DAC = 0x%x", vdac);
|
|
}
|
|
|
|
#define AD2MV(ad,offset,gain) ((ad-offset)*1000/gain)
|
|
void fATMA(void *arg)
|
|
{
|
|
int argc = 0, channel;
|
|
char *argv[MAX_ARGC] = {0}, *ptmp;
|
|
u16 offset, gain, vadc, mv;
|
|
analogin_t adc;
|
|
|
|
argc = parse_param(arg, argv);
|
|
channel = atoi(argv[1]);
|
|
if(channel >= 1 && channel <= 3){
|
|
if(channel == 1)
|
|
analogin_init(&adc, AD_1);
|
|
else if(channel == 2)
|
|
analogin_init(&adc, AD_2);
|
|
else
|
|
analogin_init(&adc, AD_3);
|
|
vadc = (analogin_read_u16(&adc)>>4);
|
|
analogin_deinit(&adc);
|
|
|
|
sys_adc_calibration(0, &offset, &gain);
|
|
if((offset != 0xFFFF) && (gain != 0xFFFF)){
|
|
if(vadc < offset){
|
|
mv = 0;
|
|
}else{
|
|
mv = AD2MV(vadc, offset, gain);
|
|
}
|
|
AT_PRINTK("[ATMA]: ADC%d:0x%x = %d mv", channel, vadc, mv);
|
|
}else{
|
|
AT_PRINTK("[ATMA]: ADC%d:0x%x", channel, vadc);
|
|
}
|
|
}
|
|
}
|
|
|
|
void fATMt(void *arg)
|
|
{
|
|
int argc = 0;
|
|
char *argv[MAX_ARGC] = {0};
|
|
|
|
AT_PRINTK("[ATM#]: _AT_MP_TEST_");
|
|
argc = parse_param(arg, argv);
|
|
}
|
|
|
|
void fATMx(void *arg)
|
|
{
|
|
AT_PRINTK("[ATM?]: _AT_MP_HELP_");
|
|
}
|
|
|
|
log_item_t at_mp_items[] = {
|
|
{"ATMG", fATMG,}, // MP GPIO test
|
|
{"ATMR", fATMR,}, // MP SDR test
|
|
{"ATMD", fATMD,}, // MP DAC
|
|
{"ATMA", fATMA,}, // MP ADC
|
|
{"ATM#", fATMt,}, // test command
|
|
{"ATM?", fATMx,}, // Help
|
|
#if CONFIG_ATCMD_MP_EXT0
|
|
{"ATM0", fATM0,}, // MP ext0 AT command
|
|
#endif
|
|
#if CONFIG_ATCMD_MP_EXT1
|
|
{"ATM1", fATM1,}, // MP ext1 AT command
|
|
#endif
|
|
};
|
|
|
|
void at_mp_init(void)
|
|
{
|
|
log_service_add_table(at_mp_items, sizeof(at_mp_items)/sizeof(at_mp_items[0]));
|
|
}
|
|
|
|
#if SUPPORT_LOG_SERVICE
|
|
log_module_init(at_mp_init);
|
|
#endif
|
|
|
|
#endif // #if CONFIG_ATCMD_MP
|
|
|