kopia lustrzana https://github.com/ArjanteMarvelde/uSDR-pico
97 wiersze
1.9 KiB
C
97 wiersze
1.9 KiB
C
/*
|
|
* monitor.c
|
|
*
|
|
* Created: Mar 2021
|
|
* Author: Arjan te Marvelde
|
|
*
|
|
* Command shell on stdin/stdout.
|
|
* Collects characters and parses commandstring.
|
|
*/
|
|
|
|
#include <stdio.h>
|
|
#include <string.h>
|
|
#include "pico/stdlib.h"
|
|
|
|
#include "lcd.h"
|
|
#include "si5351.h"
|
|
#include "monitor.h"
|
|
|
|
/* Monitor definitions */
|
|
#define ENDSTDIN 255
|
|
#define CR 13
|
|
#define LF 10
|
|
#define CMD_LEN 32
|
|
|
|
|
|
char mon_cmd[CMD_LEN+1];
|
|
|
|
|
|
uint8_t si5351_reg[200];
|
|
|
|
/* Commandstring parser */
|
|
char delim[] = " ";
|
|
#define NCMD 4
|
|
char shell[NCMD][3] = {"si", "lt", "fb", "xx"};
|
|
void mon_parse(char* s)
|
|
{
|
|
char *p;
|
|
int base, nreg, i;
|
|
|
|
p = s; //strtok(s, delim); // Get command part of string
|
|
for (i=0; i<NCMD; i++)
|
|
if (strncmp(p, shell[i], 2) == 0) break;
|
|
switch(i)
|
|
{
|
|
case 0:
|
|
// Next: p = strtok(NULL, delim); (returns NULL if none left)
|
|
for (i=0; i<nreg; i++) si5351_reg[i] = 0xaa;
|
|
si_getreg(si5351_reg, (uint8_t)base, (uint8_t)nreg);
|
|
for (i=0; i<nreg; i++) printf("%02x ",(int)(si5351_reg[i]));
|
|
printf("\n");
|
|
break;
|
|
case 1:
|
|
printf("%s\n", p);
|
|
lcd_test();
|
|
break;
|
|
case 2:
|
|
case 3:
|
|
printf("%s\n", p);
|
|
break;
|
|
default:
|
|
printf("??\n");
|
|
break;
|
|
}
|
|
}
|
|
|
|
void mon_init()
|
|
{
|
|
/* Initialize IOs */
|
|
stdio_init_all();
|
|
}
|
|
|
|
void mon_read(uint32_t timeout)
|
|
{
|
|
static int i = 0;
|
|
int c = getchar_timeout_us(timeout);
|
|
switch (c)
|
|
{
|
|
case PICO_ERROR_TIMEOUT: // just go-on
|
|
break;
|
|
case CR: // CR or LF:
|
|
case LF: // need to parse command string
|
|
putchar((char)c); // echo character
|
|
if (i==0) break; // already did a parse, only do it once
|
|
mon_cmd[i] = '\0'; // terminate command string
|
|
i=0; // reset index
|
|
mon_parse(mon_cmd); // process command
|
|
printf("Pico> "); // prompt
|
|
break;
|
|
default:
|
|
if ((c<32)||(c>=128)) break; // Alfanumeric?
|
|
putchar((char)c); // echo character
|
|
mon_cmd[i] = (char)c; // store in command string
|
|
if (i<CMD_LEN) i++; // check range and increment
|
|
break;
|
|
}
|
|
}
|