/*=====================================================================================================*/ void System_Init( void ) { SystemInit(); LED_Config(); KEY_Config(); RS232_Config(); I2C_Config(); Motor_Config(); nRF24L01_Config(); PID_Init(&PID_Yaw); PID_Init(&PID_Roll); PID_Init(&PID_Pitch); PID_Pitch.Kp = +3.5f; PID_Pitch.Ki = +0.004f; PID_Pitch.Kd = +4.0f; PID_Roll.Kp = +3.5f; PID_Roll.Ki = +0.004f; PID_Roll.Kd = +4.0f; PID_Yaw.Kp = +0.0f; PID_Yaw.Ki = +0.0f; PID_Yaw.Kd = +0.25f; Delay_10ms(2); }
/*=====================================================================================================*/ void System_Init(void) { SystemInit(); LED_Config(); KEY_Config(); RS232_Config(); Motor_Config(); PWM_Capture_Config(); Sensor_Config(); nRF24L01_Config(); PID_Init(&PID_Yaw); PID_Init(&PID_Roll); PID_Init(&PID_Pitch); PID_Pitch.Kp = +1.5f; PID_Pitch.Ki = +0.002f; PID_Pitch.Kd = +1.0f; PID_Roll.Kp = +1.5f; PID_Roll.Ki = +0.002f; PID_Roll.Kd = +1.0f; PID_Yaw.Kp = +0.0f; PID_Yaw.Ki = +0.0f; PID_Yaw.Kd = +0.0f; Delay_10ms(2); }
/*====================================================================================================*/ int main( void ) { static uint8_t i = 0; static uint8_t RecvData = 0; static int8_t State = ERROR; GPIO_Config(); RS232_Config(); LED_R = 0; printf("\r\nHello World!\r\n\r\n"); while(1) { LED_G = !LED_G; State = RS232_RecvDataWTO((int8_t*)&RecvData, 1, 200); if(State == ERROR) { printf("Timeout ... %d\r\n", i); i = (i == 255) ? 0 : i + 1; } else if(RecvData == 0x0D) // if press enter RS232_SendStr((int8_t*)"\r\n"); else RS232_SendData((int8_t*)&RecvData, 1); } }
/*====================================================================================================*/ int main( void ) { int32_t Temp = 0; GPIO_Config(); TEMP_Config(); RS232_Config(); Delay_1ms(1); RS232_SendStr("\r\nHello World!\r\n\r\n"); while(1) { LED_1_Toggle(); LED_2_Toggle(); LED_3_Toggle(); LED_4_Toggle(); Delay_100ms(5); RS232_SendStr("Chip Temp : "); Temp = (TEMP_GetTemp()*25); RS232_SendNum(Type_D, 5, Temp); RS232_SendStr(" deg\r\n"); } }
/*====================================================================================================*/ int main( void ) { SystemInit(); GPIO_Config(); RS232_Config(); NRF24L01_Config(); #if (NRF_MODE == NRF_MODE_FTLR) NRF24L01_Init(NRF_MODE_FTLR); while(1) { LED_G = !LED_G; NRF_FTLR(); } #endif #if (NRF_MODE == NRF_MODE_FRLT) NRF24L01_Init(NRF_MODE_FRLT); while(1) { LED_R = !LED_R; NRF_FRLT(); } #endif }
/*=====================================================================================================*/ int main( void ) { s16 i = 0; u8 TrData[4][16] = {0}; SystemInit(); System_SetVectorTable(IAP_FLASH_SIZE); GPIO_Config(); RS232_Config(); while(1) { PAO(1) = LED_R; PAO(2) = LED_R; PAO(3) = LED_R; PAO(4) = LED_R; PAO(5) = LED_R; PAO(6) = LED_R; PAO(7) = LED_R; PAO(8) = LED_R; PAO(11) = LED_R; PAO(12) = LED_R; PAO(15) = LED_R; PBO(0) = LED_R; PBO(1) = LED_R; PBO(3) = LED_R; PBO(4) = LED_R; PBO(5) = LED_R; PBO(6) = LED_R; PBO(7) = LED_R; PBO(8) = LED_R; PBO(9) = LED_R; PBO(10) = LED_R; PBO(11) = LED_R; PBO(12) = LED_R; PBO(13) = LED_R; PBO(14) = LED_R; PBO(15) = LED_R; LED_R = ~LED_R; Delay_10ms(10); if(KEY_BO == 1) { LED_G = ~LED_G; Delay_10ms(10); } if(KEY_WU == 1) { LED_B = ~LED_B; Delay_10ms(10); } i++; if(i == 1024) i = -1024; NumToChar(Type_I, 5, TrData[0], i); RS232_Print(USART1, (u8*)"CH1,"); RS232_Print(USART1, TrData[0]); RS232_Print(USART1, (u8*)"\r\n"); } }
void system_init(void) { LED_Config(); KEY_Config(); RS232_Config(); Motor_Config(); PWM_Capture_Config(); Sensor_Config(); nRF24L01_Config(); #if configSD_BOARD SDIO_Config(); #endif PID_Init(&PID_Yaw); PID_Init(&PID_Roll); PID_Init(&PID_Pitch); PID_Pitch.Kp = +4.0f; PID_Pitch.Ki = 0;//0.002f; PID_Pitch.Kd = +1.5f; PID_Roll.Kp = +4.0f; PID_Roll.Ki = 0;//0.002f; PID_Roll.Kd = 1.5f; PID_Yaw.Kp = +5.0f; PID_Yaw.Ki = +0.0f; PID_Yaw.Kd = +15.0f; Delay_10ms(10); Motor_Control(PWM_MOTOR_MIN, PWM_MOTOR_MIN, PWM_MOTOR_MIN, PWM_MOTOR_MIN); #if configFLIGHT_CONTROL_BOARD /* nRF Check */ while ( nRF_Check()== ERROR ); /* Sensor Init */ while(Sensor_Init() == ERROR); #endif Delay_10ms(10); /* Lock */ LED_R = 0; LED_G = 1; LED_B = 1; sys_status = SYSTEM_INITIALIZED; }
/*=====================================================================================================*/ void QCopterFC_Init( void ) { u8 Sta = ERROR; SystemInit(); LED_Config(); KEY_Config(); RS232_Config(); Motor_Config(); Sensor_Config(); nRF24L01_Config(); PID_Init(&PID_Yaw); PID_Init(&PID_Roll); PID_Init(&PID_Pitch); PID_Pitch.Kp = +1.5f; PID_Pitch.Ki = +0.002f; PID_Pitch.Kd = +1.0f; PID_Roll.Kp = +1.5f; PID_Roll.Ki = +0.002f; PID_Roll.Kd = +1.0f; PID_Yaw.Kp = +0.0f; PID_Yaw.Ki = +0.0f; PID_Yaw.Kd = +0.0f; RF_SendData.Packet = 0x00; /* Throttle Config */ if(KEY == KEY_ON) { LED_B = 0; BLDC_CtrlPWM(BLDC_PWM_MAX, BLDC_PWM_MAX, BLDC_PWM_MAX, BLDC_PWM_MAX); } while(KEY == KEY_ON); LED_B = 1; BLDC_CtrlPWM(BLDC_PWM_MIN, BLDC_PWM_MIN, BLDC_PWM_MIN, BLDC_PWM_MIN); /* nRF Check */ while(Sta == ERROR) Sta = nRF_Check(); Delay_10ms(10); /* Sensor Init */ if(Sensor_Init() == SUCCESS) LED_G = 0; Delay_10ms(10); }
/*====================================================================================================*/ int main( void ) { HAL_Init(); GPIO_Config(); RS232_Config(); printf("\r\nHello World!\r\n\r\n"); while(1) { LED_G_Toggle; Delay_100ms(1); } }
/*====================================================================================================*/ void System_Init( void ) { /* System Setup */ SystemInit(); /* Device Config */ GPIO_Config(); RS232_Config(); Sensor_Config(); LED_R = LED_ON; Sensor_Init(); AHRS_Init(&NumQ, &AngE); LED_R = LED_OFF; }
/*====================================================================================================*/ int main( void ) { GPIO_Config(); RS232_Config(); Delay_1ms(1); RS232_SendStr("\r\nHello World!\r\n\r\n"); while(1) { LED_1_Toggle(); LED_2_Toggle(); LED_3_Toggle(); LED_4_Toggle(); Delay_100ms(5); } }
/*====================================================================================================*/ int main( void ) { uint16_t ADC_Data = 0; GPIO_Config(); ADC_Config(); RS232_Config(); while(1) { LED_R_Toggle; LED_G_Toggle; LED_B_Toggle; Delay_100ms(1); ADC_Data = ADC_ReadData(); printf("ADC Read = %d\r\n", ADC_Data); } }
/*=====================================================================================================*/ int main( void ) { SystemInit(); GPIO_Config(); ADC_Config(); RS232_Config(); while(1) { LED_G = ~LED_G; ADC_Average(ADC_AveTr); RS232_SendStr(USART3, (u8*)"ADC_1 = "); RS232_SendNum(USART3, Type_D, 5, ADC_AveTr[0]); RS232_SendStr(USART3, (u8*)"\r\n"); RS232_SendStr(USART3, (u8*)"ADC_2 = "); RS232_SendNum(USART3, Type_D, 5, ADC_AveTr[1]); RS232_SendStr(USART3, (u8*)"\r\n\r\n"); } }
/*====================================================================================================*/ int main( void ) { u8 i = 0; SystemInit(); GPIO_Config(); RS232_Config(); while(1) { LED = !LED; i++; RS232_SendStr((u8*)"i = "); RS232_SendNum(Type_D, 3, i); RS232_SendStr((u8*)"\r\n"); if(i==255) i = 0; Delay_100ms(1); } }
/*=====================================================================================================*/ int main( void ) { u16 ADC_AVE[2] = {0}; SystemInit(); GPIO_Config(); ADC_Config(); RS232_Config(); while(1) { LED_G = !LED_G; Delay_100ms(1); ADC_Average(ADC_AVE, 128); RS232_SendStr((u8*)"\f"); RS232_SendStr((u8*)"ADC_I = "); RS232_SendNum(Type_D, 4, ADC_AVE[0]); RS232_SendStr((u8*)"\r\n"); RS232_SendStr((u8*)"ADC_V = "); RS232_SendNum(Type_D, 4, ADC_AVE[1]); RS232_SendStr((u8*)"\r\n"); } }
int main( void ) { u32 ReadID = 0; SystemInit(); GPIO_Config(); I2C_Config(); RS232_Config(); Delay_1ms(10); LED_B = 0; while(ReadID != (MT9V022_ID<<8 | MT9V022_ID)) { ReadID = MT9V022_Init(); LED_R = ~LED_R; Delay_100ms(1); } while(1) { LED_G = ~LED_G; Delay_100ms(1); } }
/*=====================================================================================================*/ int main( void ) { u8 TrData[8] = {0}; SystemInit(); GPIO_Config(); ADC_Config(); RS232_Config(); while(1) { LED_G = ~LED_G; ADC_Average(ADC_AveTr); TrData[0] = (u8)(ADC_AveTr[0]); TrData[1] = (u8)(ADC_AveTr[0]>>8); TrData[2] = (u8)(ADC_AveTr[1]); TrData[3] = (u8)(ADC_AveTr[1]>>8); TrData[4] = (u8)(0); TrData[5] = (u8)(0); TrData[6] = (u8)(0); TrData[7] = (u8)(0); RS232_VisualScope(USART3, TrData, 8); } }
int main( void ) { u32 i = 0; u8 ReadBuf[128] = {0}; u8 TrData[8][32] = {0}; u8 WriteData[50] = "ABCDEFG"; SystemInit(); GPIO_Config(); RS232_Config(); LED_R = 1; LED_G = 1; // SD Card Init Info RS232_SendStr(USART3, (u8*)" \r\n"); RS232_SendStr(USART3, (u8*)"----------------------\r\n"); RS232_SendStr(USART3, (u8*)"----------------------\r\n"); RS232_SendStr(USART3, (u8*)" SDIO SD FatFs demo\r\n"); RS232_SendStr(USART3, (u8*)"----------------------\r\n"); RS232_SendStr(USART3, (u8*)"----------------------\r\n\r\n"); RS232_SendStr(USART3, (u8*)" SD Init ... "); while(SD_Init() != SD_OK) { RS232_SendStr(USART3, (u8*)"Failed!!\r\n"); while(1) { LED_R = ~LED_R; Delay_100ms(2); } } RS232_SendStr(USART3, (u8*)"OK!!\r\n\r\n"); RS232_SendStr(USART3, (u8*)"-----SD Init Info-----\r\n"); RS232_SendStr(USART3, (u8*)" Capacity : "); NumToChar(Type_D, 5, TrData[0], SDCardInfo.CardCapacity>>20); RS232_SendStr(USART3, TrData[0]); RS232_SendStr(USART3, (u8*)" MB\r\n"); RS232_SendStr(USART3, (u8*)" CardBlockSize : "); NumToChar(Type_D, 5, TrData[1], SDCardInfo.CardBlockSize); RS232_SendStr(USART3, TrData[1]); RS232_SendStr(USART3, (u8*)"\r\n"); RS232_SendStr(USART3, (u8*)" CardType : "); NumToChar(Type_D, 5, TrData[2], SDCardInfo.CardType); RS232_SendStr(USART3, TrData[2]); RS232_SendStr(USART3, (u8*)"\r\n"); RS232_SendStr(USART3, (u8*)" RCA : "); NumToChar(Type_D, 5, TrData[3], SDCardInfo.RCA); RS232_SendStr(USART3, TrData[3]); RS232_SendStr(USART3, (u8*)"\r\n"); RS232_SendStr(USART3, (u8*)"----------------------\r\n"); RS232_SendStr(USART3, (u8*)"\r\n"); // Wait while(KEY != 1){ LED_G = ~LED_G; Delay_100ms(2); } // Read Directory File RS232_SendStr(USART3, (u8*)"----------------------\r\n"); RS232_SendStr(USART3, (u8*)" SD_Card Read Directory File\r\n"); RS232_SendStr(USART3, (u8*)"----------------------\r\n\r\n"); res = f_mount(&FatFs, "", 1); res = f_opendir(&dirs, "0:/"); res = f_readdir(&dirs, &finfo); while(res!= FR_OK) { RS232_SendStr(USART3, (u8*)" FatFs failed!!\r\n"); while(1) { LED_R = ~LED_R; Delay_100ms(2); } } RS232_SendStr(USART3, (u8*)" File name : \r\n"); while(finfo.fname[0]) { f_readdir(&dirs, &finfo); if(!finfo.fname[0]) break; RS232_SendStr(USART3, (u8*)" ... "); RS232_SendStr(USART3, (u8*)finfo.fname); RS232_SendStr(USART3, (u8*)"\r\n"); } // Wait while(KEY != 1){ LED_G = ~LED_G; Delay_100ms(2); } // Write File RS232_SendStr(USART3, (u8*)" f_open ... "); res = f_open(&file,"SDCard_K.txt", FA_OPEN_ALWAYS | FA_READ | FA_WRITE); if(res==FR_OK) RS232_SendStr(USART3, (u8*)"OK!!\r\n"); else RS232_SendStr(USART3, (u8*)"failed!!\r\n"); RS232_SendStr(USART3, (u8*)" f_write ... "); res = f_write(&file, WriteData, 20, (UINT *)&i); if(res==FR_OK) RS232_SendStr(USART3, (u8*)"OK!!\r\n"); else RS232_SendStr(USART3, (u8*)"failed!!\r\n"); file.fptr = 0; RS232_SendStr(USART3, (u8*)" f_read ... "); res = f_read(&file, ReadBuf, 100, (UINT *)&i); if(res==FR_OK) RS232_SendStr(USART3, (u8*)"OK!!\r\n"); else RS232_SendStr(USART3, (u8*)"failed!!\r\n"); f_close(&file); RS232_SendStr(USART3, ReadBuf); while(1) { LED_G = ~LED_G; Delay_100ms(2); } }
int main( void ) { u32 i = 0; u8 FileNum = 0; u8 ReadBuf[128] = {0}; u8 WriteData[50] = "ABCDEFG"; SystemInit(); GPIO_Config(); RS232_Config(); R61581_Config(); R61581_Init(); LED_R = 1; LED_G = 1; LED_B = 1; LED_Y = 1; LED_R = 0; LCD_Clear(BLACK); // SD Card Init Info #define Axis_X 10 #define Axis_Y 0 LCD_PutStr(Axis_X, Axis_Y+16*0, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*1, (u8*)" SDIO SD Fatfs demo", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*2, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*3, (u8*)" SD Init ... ", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)" \r\n"); RS232_SendStr(USART2, (u8*)"----------------------\r\n"); RS232_SendStr(USART2, (u8*)"----------------------\r\n"); RS232_SendStr(USART2, (u8*)" SDIO SD FatFs demo\r\n"); RS232_SendStr(USART2, (u8*)"----------------------\r\n"); RS232_SendStr(USART2, (u8*)"----------------------\r\n\r\n"); RS232_SendStr(USART2, (u8*)" SD Init ... "); while(SD_Init() != SD_OK) { LCD_PutStr(Axis_X+8*13, Axis_Y+16*3, (u8*)"Failed!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"Failed!!\r\n"); while(1) { LED_R = ~LED_R; Delay_100ms(2); } } LCD_PutStr(Axis_X+8*13, Axis_Y+16*3, (u8*)"OK!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"OK!!\r\n\r\n"); LCD_PutStr(Axis_X, Axis_Y+16*5, (u8*)"---- SD Init Info -----", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*6, (u8*)" Capacity : ", ASCII1608, WHITE, BLACK); LCD_PutNum(Axis_X+8*12, Axis_Y+16*6, Type_D, 5, SDCardInfo.CardCapacity>>20, WHITE, BLACK); LCD_PutStr(Axis_X+8*17, Axis_Y+16*6, (u8*)" MB", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*7, (u8*)" CardBlockSize : ", ASCII1608, WHITE, BLACK); LCD_PutNum(Axis_X+8*17, Axis_Y+16*7, Type_D, 5, SDCardInfo.CardBlockSize, WHITE, BLACK); LCD_PutStr(Axis_X+8*22, Axis_Y+16*7, (u8*)" ", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*8, (u8*)" CardType : ", ASCII1608, WHITE, BLACK); LCD_PutNum(Axis_X+8*12, Axis_Y+16*8, Type_D, 5, SDCardInfo.CardType, WHITE, BLACK); LCD_PutStr(Axis_X+8*17, Axis_Y+16*8, (u8*)" ", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*9, (u8*)" RCA : ", ASCII1608, WHITE, BLACK); LCD_PutNum(Axis_X+8*7, Axis_Y+16*9, Type_D, 5, SDCardInfo.RCA, WHITE, BLACK); LCD_PutStr(Axis_X+8*12, Axis_Y+16*9, (u8*)" ", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*10, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"-----SD Init Info-----\r\n"); RS232_SendStr(USART2, (u8*)" Capacity : "); RS232_SendNum(USART2, Type_D, 5, SDCardInfo.CardCapacity>>20); RS232_SendStr(USART2, (u8*)" MB\r\n"); RS232_SendStr(USART2, (u8*)" CardBlockSize : "); RS232_SendNum(USART2, Type_D, 5, SDCardInfo.CardBlockSize); RS232_SendStr(USART2, (u8*)"\r\n"); RS232_SendStr(USART2, (u8*)" CardType : "); RS232_SendNum(USART2, Type_D, 5, SDCardInfo.CardType); RS232_SendStr(USART2, (u8*)"\r\n"); RS232_SendStr(USART2, (u8*)" RCA : "); RS232_SendNum(USART2, Type_D, 5, SDCardInfo.RCA); RS232_SendStr(USART2, (u8*)"\r\n"); RS232_SendStr(USART2, (u8*)"----------------------\r\n"); RS232_SendStr(USART2, (u8*)"\r\n"); Delay_100ms(1); //////////////////// Wait while(KEY_S2 != 1){ LED_G = ~LED_G; Delay_100ms(5); } LED_G = 0; LCD_Clear(BLACK); // Read Directory File LCD_PutStr(Axis_X, Axis_Y+16*0, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*1, (u8*)" SD_Card Read Directory", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*2, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"----------------------\r\n"); RS232_SendStr(USART2, (u8*)" SD_Card Read Directory File\r\n"); RS232_SendStr(USART2, (u8*)"----------------------\r\n\r\n"); res = f_mount(&FatFs, "", 1); res = f_opendir(&dirs, "0:/"); res = f_readdir(&dirs, &finfo); while(res!= FR_OK) { LCD_PutStr(Axis_X, Axis_Y+16*3, (u8*)" Fatfs failed!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)" FatFs failed!!\r\n"); while(1) { LED_R = ~LED_R; Delay_100ms(2); } } LCD_PutStr(Axis_X, Axis_Y+16*3, (u8*)" File name : ", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)" File name : \r\n"); while(finfo.fname[0]) { f_readdir(&dirs, &finfo); if(!finfo.fname[0]) break; if(FileNum<11) { LCD_PutStr(Axis_X, Axis_Y+16*(3+FileNum), (u8*)" ... ", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X+8*5, Axis_Y+16*(3+FileNum), (u8*)finfo.fname, ASCII1608, WHITE, BLACK); } else if((FileNum>=11) && (FileNum<22)) { LCD_PutStr(Axis_X+200, Axis_Y+16*(3+FileNum-11), (u8*)" ... ", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X+8*5+200, Axis_Y+16*(3+FileNum-11), (u8*)finfo.fname, ASCII1608, WHITE, BLACK); } else { FileNum = 0; break; } FileNum++; RS232_SendStr(USART2, (u8*)" ... "); RS232_SendStr(USART2, (u8*)finfo.fname); RS232_SendStr(USART2, (u8*)"\r\n"); } Delay_100ms(1); //////////////////// Wait while(KEY_S2 != 1){ LED_B = ~LED_B; Delay_100ms(5); } LED_B = 0; LCD_Clear(BLACK); // Write File LCD_PutStr(Axis_X, Axis_Y+16*0, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*1, (u8*)" SD_Card Write Data", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X, Axis_Y+16*2, (u8*)"-----------------------", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"-----------------------\r\n"); RS232_SendStr(USART2, (u8*)" SD_Card Write Data File\r\n"); RS232_SendStr(USART2, (u8*)"-----------------------\r\n\r\n"); LCD_PutStr(Axis_X, Axis_Y+16*3, (u8*)" f_open ... ", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)" f_open ... "); res = f_open(&file,"SDCard_K.txt", FA_OPEN_ALWAYS | FA_READ | FA_WRITE); if(res==FR_OK) { LCD_PutStr(Axis_X+8*12, Axis_Y+16*3, (u8*)"OK!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"OK!!\r\n"); } else { LCD_PutStr(Axis_X+8*12, Axis_Y+16*3, (u8*)"failed!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"failed!!\r\n"); } LCD_PutStr(Axis_X, Axis_Y+16*4, (u8*)" f_write ... ", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)" f_write ... "); res = f_write(&file, WriteData, 20, &i); if(res==FR_OK) { LCD_PutStr(Axis_X+8*13, Axis_Y+16*4, (u8*)"OK!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"OK!!\r\n"); } else { LCD_PutStr(Axis_X+8*13, Axis_Y+16*4, (u8*)"failed!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"failed!!\r\n"); } file.fptr = 0; LCD_PutStr(Axis_X, Axis_Y+16*5, (u8*)" f_read ... ", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)" f_read ... "); res = f_read(&file, ReadBuf, 100, &i); if(res==FR_OK) { LCD_PutStr(Axis_X+8*12, Axis_Y+16*5, (u8*)"OK!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"OK!!\r\n"); } else { LCD_PutStr(Axis_X+8*12, Axis_Y+16*5, (u8*)"failed!!", ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, (u8*)"failed!!\r\n"); } f_close(&file); LCD_PutStr(Axis_X, Axis_Y+16*7, (u8*)" Read String : ", ASCII1608, WHITE, BLACK); LCD_PutStr(Axis_X+8*1, Axis_Y+16*8, (u8*)ReadBuf, ASCII1608, WHITE, BLACK); RS232_SendStr(USART2, ReadBuf); while(1) { LED_Y = ~LED_Y; Delay_100ms(2); } }