/*******************************************************************************
* Function Name : Menu_Init
* Description : Initializes the navigation menu.
* Input : None
* Output : None
* Return : None
*******************************************************************************/
void Menu_Init(void)
{
DelayResolution100us(Dly);
GLCD_PowerUpInit(0x0);
GLCD_Backlight(BACKLIGHT_ON);
GLCD_SetFont(&Terminal_9_12_6,0xF,0xFFF);
psCurrentMenu = &MainMenu;
psPrevMenu[nMenuLevel] = psCurrentMenu;
psMenuItem = MainMenuItems;
}
void main(void)
{
ENTR_CRT_SECTION();
/* Setup STM32 system (clock, PLL and Flash configuration) */
SystemInit();
/* Set the Vector Table base location at 0x08000000 */
NVIC_SetVectorTable(NVIC_VectTab_FLASH, 0x0);
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4);
// SysTick end of count event each 0.5s with input clock equal to 9MHz (HCLK/8, default)
SysTick_Config(1500000);
SysTick_CLKSourceConfig(SysTick_CLKSource_HCLK_Div8);
// Step motor init
StepMotorInit();
// I2C1 init
I2C1_Init();
EXT_CRT_SECTION();
// GLCD init
GLCD_PowerUpInit((pInt8U)IAR_Logo.pPicStream); //(
GLCD_Backlight(BACKLIGHT_ON);
GLCD_SetFont(&Terminal_9_12_6,0x000F00,0x00FF0);
GLCD_SetWindow(10,104,131,131);
// Init Accl sensor
if(FALSE == Accl_Init())
{
// Initialization fault
GLCD_TextSetPos(0,0);
GLCD_print("\fLIS3LV020 Init.\r\nfault\r\n");
while(1);
}
Car_Init();
while(1)
{
A=position();
/* A = accX[1];
B = velX[1];
C = posX[1]; */
if(SysTickFl) //
{
SysTickFl = FALSE;
GLCD_TextSetPos(0,0);
GLCD_print("\f%d Deg\r\n",A);
}
GoCar(Test, TestTurn);
}
}
/**
* @brief Main program.
* @param None
* @retval None
*/
int main(void)
{
/*!< At this stage the microcontroller clock setting is already configured,
this is done through SystemInit() function which is called from startup
file (startup_stm32f4xx.s) before to branch to application main.
To reconfigure the default setting of SystemInit() function, refer to
system_stm32f4xx.c file
*/
/* Setup STM32 system (clock, PLL and Flash configuration) */
SystemInit();
/* GLCD init */
GLCD_PowerUpInit((pInt8U)IAR_Logo.pPicStream);
GLCD_Backlight(BACKLIGHT_ON);
DelayResolution100us(5000);
GLCD_PowerUpInit((pInt8U)STM32_Logo.pPicStream);
GLCD_SetFont(&Terminal_9_12_6,0x000F00,0x00FF0);
GLCD_TextSetPos(4,6);
GLCD_print("STM32F407ZG-SK");
GLCD_Backlight(BACKLIGHT_ON);
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);
/* Menu init */
Menu_Init();
Joystick_Init();
DisplayMenu();
/* Infinite loop */
while (1)
{
}
}
void main(void)
{
ENTR_CRT_SECTION();
/* Setup STM32 system (clock, PLL and Flash configuration) */
SystemInit();
/* Set the Vector Table base location at 0x08000000 */
NVIC_SetVectorTable(NVIC_VectTab_FLASH, 0x0);
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_4);
// I2C1 init
I2C1_Init();
EXT_CRT_SECTION();
// GLCD init
GLCD_PowerUpInit(0x0); //(
GLCD_Backlight(BACKLIGHT_ON);
GLCD_SetFont(&Terminal_9_12_6,0x000F00,0x00FF0);
GLCD_SetWindow(10,10,131,131);
// Init Accl sensor
if(FALSE == Accl_Init())
{
// Initialization fault
GLCD_TextSetPos(0,0);
GLCD_print("\fLIS3LV020 Init.\r\nfault\r\n");
while(1);
}
//Init CarControl and Delay
Car_Init();
DWT_Init();
HCSR04_Init();
// SysTick end of count event each 0.5s with input clock equal to 9MHz (HCLK/8, default)
SysTick_Config(150000);
SysTick_CLKSourceConfig(SysTick_CLKSource_HCLK_Div8);
DWT_Delayms(1000);
while(1)
{
//while(1){GLCD_print("Current state: %d \r",GPIO_ReadInputDataBit(JS_LEFT_PORT, JS_LEFT_MASK));}
//car_feedback=accl_feedback();
/* A = accX[1];
B = velX[1];
C = posX[1]; */
if(SysTickF1)
{
SysTickF1 = FALSE;
//GLCD_TextSetPos(0,0);
GLCD_print("%d, %d \r", get_Xvel(), accl_feedback());
DWT_Delayms(500);
}
if(NewInstr) //
{
DWT_Delayms(1000);
NewInstr = FALSE;
//GoCar(Test, TestTurn);
// 1. Give command (desired state)
//desiredState;
// 2. Run machine learning to test action
action = goToState(car_instr);
GoCars(action);
// testExp();
int runTime = 0;
while (runTime < 1){
DWT_Delayms(700);
runTime++;
}
GLCD_TextSetPos(0,0);
GLCD_print("\f%d,%d;%d,%d\r\n", get_X_accFeedback(0), get_Y_accFeedback(0), get_X_vel(0), get_Y_vel(0));
GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(1), get_Y_accFeedback(1), get_X_vel(1), get_Y_vel(1));
GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(2), get_Y_accFeedback(2), get_X_vel(2), get_Y_vel(2));
GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(3), get_Y_accFeedback(3), get_X_vel(3), get_Y_vel(3));
GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(4), get_Y_accFeedback(4), get_X_vel(4), get_Y_vel(4));
GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(5), get_Y_accFeedback(5), get_X_vel(5), get_Y_vel(5));
GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(6), get_Y_accFeedback(6), get_X_vel(6), get_Y_vel(6));
// GLCD_print("%d,%d;%d,%d\r\n", get_X_accFeedback(7), get_Y_accFeedback(7), get_X_vel(7), get_Y_vel(7));
car_instr=car_stop;
GoCars(car_instr);
DWT_Delayms(2000);
}
//GoCars(3); //Stopping the car
// 3. Wait x ms
//Wait in ML-method testAllActions
// 4. Return value from accelerometer
//Return value from accelerometer in ML-method testAllActions
// 5. Evaluate action compared to state
//Already implemented in ML-file. No need to alter (probably)
// 6. Repeat 3-5 until all actions has been tested
//Already implemented in ML-file. No need to alter (probably)
// 7. Choose the correct state
//Already implemented in ML-file. No need to alter (probably)
}
}
