euint32 main(void)
{
//initialise variables
euint8 buffersd[size];
euint32 i;
currDir.ParentAdd = 0;
currDir.name[0] = '/';
currDir.name[1] = 0;
currDir.startH = 0;
currDir.startL = 2;
root.ParentAdd = 0;
root.name[0] = '/';
root.name[1] = 0;
root.startH = 0;
root.startL = 2;
audio_initialise();
uart_file = open("/dev/uart_0",O_RDWR);
// Prepare UART for command input
printf("UART Ready.\n");
UART_write("UART Ready.\r\n");
// Initialise file system
if(SD_init()==1)
{
printf("Could not open filesystem.\n");
UART_write("File System could not mount.\r\n\t");
}
else
{
//FS mounted
printf("File System Ready.\r\n");
UART_write("File System Ready.\r\n");
}
read_mboot(buffersd);
//calculates LBAbegin
for(i=454;i<459;i++)
{
*((euint8*)&LBAbegin+(i-454)) = buffersd[i];
}
read_part_boot(LBAbegin,&Part_Boot); //reads the partition boot and fills the global variable
char buffer[128];
char* array[10];
char* temp[10];
while(1)
{
UART_write(">");
if(uart_file == 0)
{
printf("Sorry UART open failed\r\n");
return(-1);//error
}
euint32 number;
euint32 xx=0;
for(xx=0;xx<128;xx++)
{
buffer[xx]=0;//empty buffer
}
for(xx=0;xx<10;xx++)
{
array[xx] = 0;
temp[xx]=0;
}
UARTListener(&buffer,uart_file);
number = string_parser(buffer,array);
euint32 i = 0;
// search through commands to find match
if(array[0]!=0)
{
for(i=0;i<3;i++)
{
//if string match found
if (strcompare(array[0],list[i].com_string)==0)
{
//extract the arguments of command
euint32 j;
for( j=0;j<number-1;j++)
{
temp[j] = array[j+1];
//free(array[j+1]);
}
//call relative function
list[i].com_fun((number-1),temp);
for( j=0;j<number-1;j++)
{
free(array[j+1]);
}
i=56;//exit loop
}
}
if(i==3)
{
UART_write("Error : Command Not Found!\r\n");
}
}
free(array[0]);
}
return 0;
}
int main(void)
{
// INITIALISATIONS
float x = 0.0;
float y = 0.0;
float theta = 0.0;
float vel = 0.0;
float velref = 0.0;
float Mvel = 0.0;
char* word_array[MAX_CMDS];
int no_of_words = 0;
int error = 1;
DDRC |= 1 << 5; // PortC.5 as output
lb_init(&lb); // init line buffer lb
uart_init(); // init USART
enc_init(); // init Encoder
ctrl_init(); // init Controller
motor_init(); // init Motor
sei(); // enable interrupts
printf_P(PSTR("Sup Bitches\nThis is Command\n"));
for (;/*ever*/;)
{
while (uart_avail())
{
char c = uart_getc(); //gets character from circular buffer
if (lb_append(&lb, c) == LB_BUFFER_FULL) // Add character "c" to line buffer, report status(putc) and handle special characters(append)
{
lb_init(&lb); // Clear line buffer, discards input
printf_P(PSTR("\nMax line length exceeded\n"));
}
}
error = 1;
// Process command if line buffer is terminated by a line feed or carriage return
if (lb_line_ready(&lb)) //if not empty and has null terminator
{
for (int j = 0; j < NUM_CMDS; j++) //re-setting word_array to zero
{
word_array[j] = 0;
}
no_of_words = string_parser( lb_gets(&lb), word_array); // gets serial, puts into word_array
for (int i=0; cmd_table[i].cmd != NULL; ++i) //
{
if( !strcmp(word_array[0], cmd_table[i].cmd))
{
error = 0;
cmd_table[i].func(no_of_words, word_array);
}
}
lb_init(&lb);
// Error checking
if(!no_of_words)
{
printf_P(PSTR("No Command Entered\n"));
}
if(error)
{
printf_P(PSTR("Invalid Command\n"));
}
/* // Note: The following is a terrible way to process strings from the user
// See recommendations section of the lab guide for a better way to
// handle commands with arguments, which scales well to a large
// number of commands.
if (!strncmp_P(lb_gets(&lb), PSTR("help"), 4))
{
printf_P(PSTR(
"MCHA3000 RS232 lab help.\n"
"Replace these lines with your own help instructions.\n"));
}
else if (!strncmp_P(lb_gets(&lb), PSTR("x="), 2)) // takes 'x' co-ordinate
{
x = atof(lb_gets_at(&lb, 2));
}
else if (!strncmp_P(lb_gets(&lb), PSTR("x?"), 2)) // prints 'x' co-ordinate to serial
{
printf_P(PSTR("x is %f\n"), x);
}
else if (!strncmp_P(lb_gets(&lb), PSTR("y="), 2)) // takes 'y' co-ordinate
{
y = atof(lb_gets_at(&lb, 2));
}
else if (!strncmp_P(lb_gets(&lb), PSTR("xy?"), 3)) // prints 'x'*'y' to serial
{
printf_P(PSTR("%f\n"), x*y);
}
else if (!strncmp_P(lb_gets(&lb), PSTR("theta="), 6)) // HIL: takes 'theta'
{
theta = atof(lb_gets_at(&lb, 6));
}
else if (!strncmp_P(lb_gets(&lb), PSTR("vel="), 4)) // HIL: takes 'vel'
{
vel = atof(lb_gets_at(&lb, 4));
}
else if (!strncmp_P(lb_gets(&lb), PSTR("velref="), 7)) // HIL: takes 'velref'
{
velref = atof(lb_gets_at(&lb, 7));
}
else if (!strncmp_P(lb_gets(&lb), PSTR("ctrl?"), 5)) // HIL: initialises feedback loop for cascade controller
{ // and prints control action to serial
float outer_loop = velocity_controller(velref - vel);
float inner_loop = angle_controller(outer_loop - theta);
printf_P(PSTR("%g\n"), inner_loop);
}
else if (!strncmp_P(lb_gets(&lb), PSTR("ecount?"), 7)) // prints enc_count
{
printf_P(PSTR("Encoder1 Count = %d\n"), enc_read1());
printf_P(PSTR("Encoder2 Count = %d\n"), enc_read2());
}
else if (!strncmp_P(lb_gets(&lb), PSTR("ereset"), 6)) // Resets enc_count then prints count
{
enc_reset();
printf_P(PSTR("Encoder1 Count = %d\n"), enc_read1());
printf_P(PSTR("Encoder2 Count = %d\n"), enc_read2());
}
else if (!strncmp_P(lb_gets(&lb), PSTR("mvel="), 5)) // Motor On/Off
{
Mvel=atof(lb_gets_at(&lb, 5));
motor_vel(Mvel);
printf_P(PSTR("Motor Velocity = %f\n"), Mvel);
}
else if (!strncmp_P(lb_gets(&lb), PSTR("I"), 1)) // Motor Current
{
printf_P(PSTR("Motor Current = %f\n"), motor_current());
}
else // WARNING: Unknown command
{
printf_P(PSTR("Unknown command: \"%s\"\n"), lb_gets(&lb));
}
lb_init(&lb); // Reset line buffer
*/
}
}
return 0;
}
