I made Digital Camera using Arducam & WIZwiki-W7500
Dependencies: Arduino Arducam_OV5642 SDFileSystem Arducam_UTFT_SPI WIZnetInterface_Ricky mbed
main.cpp@5:e47189da7d92, 2015-10-29 (annotated)
- Committer:
- justinkim
- Date:
- Thu Oct 29 23:35:16 2015 +0000
- Revision:
- 5:e47189da7d92
- Parent:
- 4:63042b865304
I made Digital Camera using Arducam & WIZwiki-W7500
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
justinkim | 0:e01f64037748 | 1 | #include "mbed.h" |
justinkim | 0:e01f64037748 | 2 | #include "UTFT_SPI.h" |
justinkim | 0:e01f64037748 | 3 | #include "OV5642.h" |
justinkim | 0:e01f64037748 | 4 | #include "OV5642_regs.h" |
justinkim | 3:23d439c8526b | 5 | #include "SDFileSystem.h" |
justinkim | 0:e01f64037748 | 6 | #include "Arduino.h" |
justinkim | 4:63042b865304 | 7 | #include "EthernetInterface.h" |
justinkim | 4:63042b865304 | 8 | #include <stdio.h> |
justinkim | 4:63042b865304 | 9 | #include <string.h> |
justinkim | 0:e01f64037748 | 10 | |
justinkim | 0:e01f64037748 | 11 | ArduCAM myCAM(D11, D12, D13, D10, D14, D15); |
justinkim | 1:3a14a4c84db2 | 12 | ArduLCD myGLCD(D11, D12, D13, D10); |
justinkim | 3:23d439c8526b | 13 | SDFileSystem sd(D11, D12, D13, D9, "sd"); |
justinkim | 4:63042b865304 | 14 | |
justinkim | 0:e01f64037748 | 15 | Serial pc(USBTX, USBRX); |
justinkim | 3:23d439c8526b | 16 | bool isShowFlag = true; |
justinkim | 4:63042b865304 | 17 | char fnamecamera[32]; |
justinkim | 4:63042b865304 | 18 | char fnamecntcamera=0; |
justinkim | 4:63042b865304 | 19 | |
justinkim | 4:63042b865304 | 20 | /* FTP */ |
justinkim | 4:63042b865304 | 21 | #define USER "user " |
justinkim | 4:63042b865304 | 22 | #define PASS "pass " |
justinkim | 4:63042b865304 | 23 | #define PASV "pasv " |
justinkim | 4:63042b865304 | 24 | #define PORT "port " |
justinkim | 4:63042b865304 | 25 | #define LIST "list " |
justinkim | 4:63042b865304 | 26 | #define STOR "stor " |
justinkim | 4:63042b865304 | 27 | #define RETR "retr " |
justinkim | 4:63042b865304 | 28 | #define END "\r\n" |
justinkim | 4:63042b865304 | 29 | #define FTP_SERVER_PORT 21 |
justinkim | 4:63042b865304 | 30 | #define MAX_SS 256 |
justinkim | 4:63042b865304 | 31 | bool gDataSockReady = false; |
justinkim | 4:63042b865304 | 32 | bool gDataPutGetStart = false; |
justinkim | 4:63042b865304 | 33 | bool ftpclientrun = false; |
justinkim | 4:63042b865304 | 34 | int remote_port; |
justinkim | 4:63042b865304 | 35 | char ftpServer_data_ip_addr[4]={0,}; |
justinkim | 4:63042b865304 | 36 | char ftpServer_data_ip_addr_str[20]={0,}; |
justinkim | 4:63042b865304 | 37 | static char buf[256]; |
justinkim | 4:63042b865304 | 38 | static char ID[]={"abc"}; //Set FTPServer Login ID |
justinkim | 4:63042b865304 | 39 | static char PASSWORD[]={"123"}; //Set FTPServer Login Password |
justinkim | 4:63042b865304 | 40 | enum CommandFirst { |
justinkim | 4:63042b865304 | 41 | f_nocmd, |
justinkim | 4:63042b865304 | 42 | f_put, |
justinkim | 4:63042b865304 | 43 | }; |
justinkim | 4:63042b865304 | 44 | enum CommandSecond { |
justinkim | 4:63042b865304 | 45 | s_nocmd, |
justinkim | 4:63042b865304 | 46 | s_put, |
justinkim | 4:63042b865304 | 47 | }; |
justinkim | 4:63042b865304 | 48 | enum ftpc_datasock_state{ |
justinkim | 4:63042b865304 | 49 | DATASOCK_IDLE, |
justinkim | 4:63042b865304 | 50 | DATASOCK_READY, |
justinkim | 4:63042b865304 | 51 | DATASOCK_START |
justinkim | 4:63042b865304 | 52 | }; |
justinkim | 4:63042b865304 | 53 | struct Command { |
justinkim | 4:63042b865304 | 54 | enum CommandFirst First; |
justinkim | 4:63042b865304 | 55 | enum CommandSecond Second; |
justinkim | 4:63042b865304 | 56 | }; |
justinkim | 4:63042b865304 | 57 | struct ftpc { |
justinkim | 4:63042b865304 | 58 | enum ftpc_datasock_state dsock_state; |
justinkim | 4:63042b865304 | 59 | }; |
justinkim | 4:63042b865304 | 60 | struct ftpc FTPClient; |
justinkim | 4:63042b865304 | 61 | struct Command FTPCommand; |
justinkim | 4:63042b865304 | 62 | |
justinkim | 4:63042b865304 | 63 | /* SD Card filesystem */ |
justinkim | 4:63042b865304 | 64 | static FILE *fp_jpeg; |
justinkim | 3:23d439c8526b | 65 | char fname[32]; |
justinkim | 4:63042b865304 | 66 | char fname_server[16]; |
justinkim | 3:23d439c8526b | 67 | char fnamecnt=0; |
justinkim | 4:63042b865304 | 68 | char gMsgBuf[10]; |
justinkim | 4:63042b865304 | 69 | char User_Keyboard_MSG_Cnt; |
justinkim | 4:63042b865304 | 70 | /* Function*/ |
justinkim | 4:63042b865304 | 71 | char* User_Keyboard_MSG(void); |
justinkim | 4:63042b865304 | 72 | int pportc(char * arg); |
justinkim | 4:63042b865304 | 73 | void FTP_server_uploader(); |
justinkim | 4:63042b865304 | 74 | void setup(); |
justinkim | 4:63042b865304 | 75 | void loop(); |
justinkim | 4:63042b865304 | 76 | void itoa( unsigned long long int value, char *str); |
justinkim | 0:e01f64037748 | 77 | |
justinkim | 0:e01f64037748 | 78 | int main() |
justinkim | 0:e01f64037748 | 79 | { |
justinkim | 4:63042b865304 | 80 | *(volatile uint32_t *)(0x41001014) = 0x0060200; //clock 24MHz |
justinkim | 0:e01f64037748 | 81 | |
justinkim | 0:e01f64037748 | 82 | setup(); |
justinkim | 0:e01f64037748 | 83 | |
justinkim | 4:63042b865304 | 84 | //FTP_server_uploader(); |
justinkim | 0:e01f64037748 | 85 | while(1) |
justinkim | 0:e01f64037748 | 86 | { |
justinkim | 4:63042b865304 | 87 | loop(); |
justinkim | 4:63042b865304 | 88 | } |
justinkim | 0:e01f64037748 | 89 | } |
justinkim | 0:e01f64037748 | 90 | |
justinkim | 0:e01f64037748 | 91 | void setup() |
justinkim | 0:e01f64037748 | 92 | { |
justinkim | 4:63042b865304 | 93 | uint8_t vid,pid; |
justinkim | 4:63042b865304 | 94 | uint8_t temp; |
justinkim | 1:3a14a4c84db2 | 95 | |
justinkim | 4:63042b865304 | 96 | pc.baud(115200); |
justinkim | 4:63042b865304 | 97 | |
justinkim | 4:63042b865304 | 98 | pc.printf("ArduCAM Start!\r\n"); |
justinkim | 4:63042b865304 | 99 | |
justinkim | 4:63042b865304 | 100 | uint8_t temp1,temp2; |
justinkim | 4:63042b865304 | 101 | myCAM.write_reg(ARDUCHIP_TEST1, 0x55); //Write to test1 register by 0x55 |
justinkim | 4:63042b865304 | 102 | myCAM.write_reg(ARDUCHIP_TEST2, 0xAA); //Write to test1 register by 0xaa |
justinkim | 4:63042b865304 | 103 | wait_ms(1000); |
justinkim | 4:63042b865304 | 104 | temp1 = myCAM.read_reg(ARDUCHIP_TEST1); //Read from test1 register |
justinkim | 4:63042b865304 | 105 | temp2 = myCAM.read_reg(ARDUCHIP_TEST2); //Read from test1 register |
justinkim | 4:63042b865304 | 106 | pc.printf("temp1 : %d\r\n",temp1); |
justinkim | 4:63042b865304 | 107 | pc.printf("temp2 : %d\r\n",temp2); |
justinkim | 4:63042b865304 | 108 | wait_ms(1000); |
justinkim | 4:63042b865304 | 109 | |
justinkim | 4:63042b865304 | 110 | myCAM.write_reg(ARDUCHIP_TEST1, 0x55); |
justinkim | 4:63042b865304 | 111 | temp = myCAM.read_reg(ARDUCHIP_TEST1); |
justinkim | 1:3a14a4c84db2 | 112 | |
justinkim | 0:e01f64037748 | 113 | if(temp != 0x55) |
justinkim | 0:e01f64037748 | 114 | { |
justinkim | 0:e01f64037748 | 115 | pc.printf("SPI interface Error!\r\n"); |
justinkim | 0:e01f64037748 | 116 | while(1); |
justinkim | 0:e01f64037748 | 117 | } |
justinkim | 0:e01f64037748 | 118 | |
justinkim | 0:e01f64037748 | 119 | //Change MCU mode |
justinkim | 0:e01f64037748 | 120 | myCAM.set_mode(MCU2LCD_MODE); |
justinkim | 0:e01f64037748 | 121 | |
justinkim | 0:e01f64037748 | 122 | //Initialize the LCD Module |
justinkim | 1:3a14a4c84db2 | 123 | myGLCD.InitLCD(); |
justinkim | 0:e01f64037748 | 124 | |
justinkim | 0:e01f64037748 | 125 | //Check if the camera module type is OV5642 |
justinkim | 0:e01f64037748 | 126 | myCAM.rdSensorReg16_8(OV5642_CHIPID_HIGH, &vid); |
justinkim | 0:e01f64037748 | 127 | myCAM.rdSensorReg16_8(OV5642_CHIPID_LOW, &pid); |
justinkim | 0:e01f64037748 | 128 | if((vid != 0x56) || (pid != 0x42)) |
justinkim | 0:e01f64037748 | 129 | pc.printf("Can't find OV5642 module!\r\n"); |
justinkim | 0:e01f64037748 | 130 | else |
justinkim | 0:e01f64037748 | 131 | pc.printf("OV5642 detected\r\n"); |
justinkim | 0:e01f64037748 | 132 | |
justinkim | 3:23d439c8526b | 133 | //Change to BMP capture mode and initialize the OV5642 module |
justinkim | 3:23d439c8526b | 134 | myCAM.set_format(BMP); |
justinkim | 3:23d439c8526b | 135 | |
justinkim | 0:e01f64037748 | 136 | myCAM.InitCAM(); |
justinkim | 0:e01f64037748 | 137 | } |
justinkim | 3:23d439c8526b | 138 | |
justinkim | 0:e01f64037748 | 139 | void loop() |
justinkim | 0:e01f64037748 | 140 | { |
justinkim | 3:23d439c8526b | 141 | FILE *outFile; |
justinkim | 3:23d439c8526b | 142 | uint8_t buf[256]; |
justinkim | 3:23d439c8526b | 143 | static int i = 0; |
justinkim | 3:23d439c8526b | 144 | uint8_t temp,temp_last; |
justinkim | 3:23d439c8526b | 145 | uint8_t start_capture = 0; |
justinkim | 3:23d439c8526b | 146 | |
justinkim | 3:23d439c8526b | 147 | //Wait trigger from shutter buttom |
justinkim | 3:23d439c8526b | 148 | if(myCAM.get_bit(ARDUCHIP_TRIG , SHUTTER_MASK)) |
justinkim | 3:23d439c8526b | 149 | { |
justinkim | 3:23d439c8526b | 150 | isShowFlag = false; |
justinkim | 3:23d439c8526b | 151 | myCAM.set_mode(MCU2LCD_MODE); |
justinkim | 3:23d439c8526b | 152 | myCAM.set_format(JPEG); |
justinkim | 3:23d439c8526b | 153 | myCAM.InitCAM(); |
justinkim | 4:63042b865304 | 154 | myCAM.OV5642_set_JPEG_size(OV5642_1920x1080); |
justinkim | 3:23d439c8526b | 155 | myCAM.write_reg(ARDUCHIP_TIM, VSYNC_LEVEL_MASK); //VSYNC is active HIGH |
justinkim | 3:23d439c8526b | 156 | |
justinkim | 3:23d439c8526b | 157 | //Wait until buttom released |
justinkim | 3:23d439c8526b | 158 | while(myCAM.get_bit(ARDUCHIP_TRIG, SHUTTER_MASK)); |
justinkim | 3:23d439c8526b | 159 | wait_ms(1000); |
justinkim | 3:23d439c8526b | 160 | start_capture = 1; |
justinkim | 3:23d439c8526b | 161 | } |
justinkim | 3:23d439c8526b | 162 | else |
justinkim | 3:23d439c8526b | 163 | { |
justinkim | 3:23d439c8526b | 164 | if(isShowFlag ) |
justinkim | 3:23d439c8526b | 165 | { |
justinkim | 0:e01f64037748 | 166 | |
justinkim | 3:23d439c8526b | 167 | if(!myCAM.get_bit(ARDUCHIP_TRIG,VSYNC_MASK)) //New Frame is coming |
justinkim | 3:23d439c8526b | 168 | { |
justinkim | 3:23d439c8526b | 169 | myCAM.set_mode(MCU2LCD_MODE); //Switch to MCU |
justinkim | 3:23d439c8526b | 170 | myGLCD.resetXY(); |
justinkim | 3:23d439c8526b | 171 | myCAM.set_mode(CAM2LCD_MODE); //Switch to CAM |
justinkim | 3:23d439c8526b | 172 | while(!myCAM.get_bit(ARDUCHIP_TRIG,VSYNC_MASK)); //Wait for VSYNC is gone |
justinkim | 3:23d439c8526b | 173 | } |
justinkim | 3:23d439c8526b | 174 | } |
justinkim | 3:23d439c8526b | 175 | } |
justinkim | 3:23d439c8526b | 176 | if(start_capture) |
justinkim | 3:23d439c8526b | 177 | { |
justinkim | 3:23d439c8526b | 178 | //Flush the FIFO |
justinkim | 3:23d439c8526b | 179 | myCAM.flush_fifo(); |
justinkim | 3:23d439c8526b | 180 | //Clear the capture done flag |
justinkim | 3:23d439c8526b | 181 | myCAM.clear_fifo_flag(); |
justinkim | 3:23d439c8526b | 182 | //Start capture |
justinkim | 3:23d439c8526b | 183 | myCAM.start_capture(); |
justinkim | 3:23d439c8526b | 184 | pc.printf("Start Capture\r\n"); |
justinkim | 3:23d439c8526b | 185 | } |
justinkim | 3:23d439c8526b | 186 | |
justinkim | 3:23d439c8526b | 187 | if(myCAM.get_bit(ARDUCHIP_TRIG ,CAP_DONE_MASK)) |
justinkim | 0:e01f64037748 | 188 | { |
justinkim | 0:e01f64037748 | 189 | |
justinkim | 3:23d439c8526b | 190 | pc.printf("Capture Done!\r\n"); |
justinkim | 3:23d439c8526b | 191 | //Construct a file name |
justinkim | 4:63042b865304 | 192 | snprintf(fnamecamera, sizeof(fnamecamera), "/sd/jpss%04d.jpg", fnamecntcamera); |
justinkim | 4:63042b865304 | 193 | fnamecntcamera++; |
justinkim | 3:23d439c8526b | 194 | //Open the new file |
justinkim | 4:63042b865304 | 195 | outFile = fopen(fnamecamera,"w"); |
justinkim | 3:23d439c8526b | 196 | if (! outFile) |
justinkim | 3:23d439c8526b | 197 | { |
justinkim | 3:23d439c8526b | 198 | pc.printf("open file failed\r\n"); |
justinkim | 3:23d439c8526b | 199 | return; |
justinkim | 3:23d439c8526b | 200 | } |
justinkim | 3:23d439c8526b | 201 | //Read first dummy byte |
justinkim | 3:23d439c8526b | 202 | //myCAM.read_fifo(); |
justinkim | 3:23d439c8526b | 203 | |
justinkim | 3:23d439c8526b | 204 | i = 0; |
justinkim | 3:23d439c8526b | 205 | temp = myCAM.read_fifo(); |
justinkim | 3:23d439c8526b | 206 | //Write first image data to buffer |
justinkim | 3:23d439c8526b | 207 | buf[i++] = temp; |
justinkim | 3:23d439c8526b | 208 | |
justinkim | 3:23d439c8526b | 209 | //Read JPEG data from FIFO |
justinkim | 3:23d439c8526b | 210 | while( (temp != 0xD9) | (temp_last != 0xFF) ) |
justinkim | 0:e01f64037748 | 211 | { |
justinkim | 3:23d439c8526b | 212 | temp_last = temp; |
justinkim | 3:23d439c8526b | 213 | temp = myCAM.read_fifo(); |
justinkim | 3:23d439c8526b | 214 | //Write image data to buffer if not full |
justinkim | 3:23d439c8526b | 215 | if(i < 256) |
justinkim | 3:23d439c8526b | 216 | buf[i++] = temp; |
justinkim | 3:23d439c8526b | 217 | else |
justinkim | 3:23d439c8526b | 218 | { |
justinkim | 3:23d439c8526b | 219 | //Write 256 bytes image data to file |
justinkim | 3:23d439c8526b | 220 | fwrite(buf,256,1,outFile); |
justinkim | 3:23d439c8526b | 221 | i = 0; |
justinkim | 3:23d439c8526b | 222 | buf[i++] = temp; |
justinkim | 3:23d439c8526b | 223 | } |
justinkim | 0:e01f64037748 | 224 | } |
justinkim | 3:23d439c8526b | 225 | //Write the remain bytes in the buffer |
justinkim | 3:23d439c8526b | 226 | if(i > 0) |
justinkim | 3:23d439c8526b | 227 | fwrite(buf,i,1,outFile); |
justinkim | 3:23d439c8526b | 228 | |
justinkim | 3:23d439c8526b | 229 | //Close the file |
justinkim | 3:23d439c8526b | 230 | fclose(outFile); |
justinkim | 3:23d439c8526b | 231 | //Clear the capture done flag |
justinkim | 3:23d439c8526b | 232 | myCAM.clear_fifo_flag(); |
justinkim | 3:23d439c8526b | 233 | //Clear the start capture flag |
justinkim | 3:23d439c8526b | 234 | start_capture = 0; |
justinkim | 3:23d439c8526b | 235 | |
justinkim | 3:23d439c8526b | 236 | myCAM.set_format(BMP); |
justinkim | 3:23d439c8526b | 237 | myCAM.InitCAM(); |
justinkim | 3:23d439c8526b | 238 | isShowFlag = true; |
justinkim | 0:e01f64037748 | 239 | } |
justinkim | 0:e01f64037748 | 240 | } |
justinkim | 3:23d439c8526b | 241 | |
justinkim | 3:23d439c8526b | 242 | /* itoa: convert n to characters in s */ |
justinkim | 3:23d439c8526b | 243 | void itoa( unsigned long long int value, char *str) |
justinkim | 3:23d439c8526b | 244 | { |
justinkim | 3:23d439c8526b | 245 | int i,j; |
justinkim | 3:23d439c8526b | 246 | char temp[30]; |
justinkim | 3:23d439c8526b | 247 | for(i=0; value > 0; i++){ |
justinkim | 3:23d439c8526b | 248 | str[i] = value%10+'0'; |
justinkim | 3:23d439c8526b | 249 | value=value/10; |
justinkim | 3:23d439c8526b | 250 | } |
justinkim | 3:23d439c8526b | 251 | for(j=0;i>=0;j++,i--){ |
justinkim | 3:23d439c8526b | 252 | temp[j]=str[i-1]; |
justinkim | 3:23d439c8526b | 253 | } |
justinkim | 3:23d439c8526b | 254 | for(i=0;i<j;i++){ |
justinkim | 3:23d439c8526b | 255 | str[i]=temp[i]; |
justinkim | 3:23d439c8526b | 256 | } |
justinkim | 3:23d439c8526b | 257 | } |
justinkim | 4:63042b865304 | 258 | |
justinkim | 4:63042b865304 | 259 | void FTP_server_uploader(){ |
justinkim | 4:63042b865304 | 260 | |
justinkim | 4:63042b865304 | 261 | char Msg_c; |
justinkim | 4:63042b865304 | 262 | int remain_filesize; |
justinkim | 4:63042b865304 | 263 | int send_byte; |
justinkim | 4:63042b865304 | 264 | |
justinkim | 4:63042b865304 | 265 | pc.printf("Hello FTP Camera!\r\n"); |
justinkim | 4:63042b865304 | 266 | |
justinkim | 4:63042b865304 | 267 | uint8_t mac_addr[6] = {0x00, 0x08, 0xdc, 0x12, 0x34, 0x45}; |
justinkim | 4:63042b865304 | 268 | const char ip_addr[] = "192.168.0.123"; // WIZwiki-W7500 IP-address |
justinkim | 4:63042b865304 | 269 | const char mask_addr[] = "255.255.255.0"; |
justinkim | 4:63042b865304 | 270 | const char gateway_addr[] = "192.168.0.1"; |
justinkim | 4:63042b865304 | 271 | const char ftpServer_control_ip_addr[] = "192.168.0.209"; // my IP address |
justinkim | 4:63042b865304 | 272 | |
justinkim | 4:63042b865304 | 273 | |
justinkim | 4:63042b865304 | 274 | EthernetInterface eth; |
justinkim | 4:63042b865304 | 275 | eth.init(mac_addr, ip_addr, mask_addr, gateway_addr); //Use Static |
justinkim | 4:63042b865304 | 276 | eth.connect(); |
justinkim | 4:63042b865304 | 277 | |
justinkim | 4:63042b865304 | 278 | TCPSocketConnection FTP_CONTROL_SOCK; |
justinkim | 4:63042b865304 | 279 | TCPSocketConnection FTP_DATA_SOCK; |
justinkim | 4:63042b865304 | 280 | |
justinkim | 4:63042b865304 | 281 | |
justinkim | 4:63042b865304 | 282 | pc.printf("\r\n----------------------------------------\r\n"); |
justinkim | 4:63042b865304 | 283 | pc.printf("Press menu key\r\n"); |
justinkim | 4:63042b865304 | 284 | pc.printf("----------------------------------------\r\n"); |
justinkim | 4:63042b865304 | 285 | pc.printf("1> Snapshot Picture and Send to FTPServer\r\n"); |
justinkim | 4:63042b865304 | 286 | pc.printf("----------------------------------------\r\n"); |
justinkim | 4:63042b865304 | 287 | Msg_c = pc.getc(); |
justinkim | 4:63042b865304 | 288 | if(Msg_c==0x31){ |
justinkim | 4:63042b865304 | 289 | |
justinkim | 4:63042b865304 | 290 | ftpclientrun = true; |
justinkim | 4:63042b865304 | 291 | while(ftpclientrun){ |
justinkim | 4:63042b865304 | 292 | //while 2 |
justinkim | 4:63042b865304 | 293 | while(!FTP_CONTROL_SOCK.is_connected()){ |
justinkim | 4:63042b865304 | 294 | pc.printf("Connecting...FTPServer\r\nIP:%s, PORT:%d\r\n", ftpServer_control_ip_addr, FTP_SERVER_PORT); |
justinkim | 4:63042b865304 | 295 | FTP_CONTROL_SOCK.connect(ftpServer_control_ip_addr, FTP_SERVER_PORT); |
justinkim | 4:63042b865304 | 296 | FTP_CONTROL_SOCK.set_blocking(false, 15000); // Timeout after (1.5)s |
justinkim | 4:63042b865304 | 297 | }//end of while 2 |
justinkim | 4:63042b865304 | 298 | |
justinkim | 4:63042b865304 | 299 | //while 3 |
justinkim | 4:63042b865304 | 300 | while(true) |
justinkim | 4:63042b865304 | 301 | { |
justinkim | 4:63042b865304 | 302 | //gDataSockReady if |
justinkim | 4:63042b865304 | 303 | if(gDataSockReady){ |
justinkim | 4:63042b865304 | 304 | gDataSockReady = false; |
justinkim | 4:63042b865304 | 305 | //FTPCommand.First switch case |
justinkim | 4:63042b865304 | 306 | switch(FTPCommand.First){ |
justinkim | 4:63042b865304 | 307 | case f_put: |
justinkim | 4:63042b865304 | 308 | FTP_CONTROL_SOCK.send(STOR, sizeof(STOR)-1); |
justinkim | 4:63042b865304 | 309 | FTP_CONTROL_SOCK.send(fname_server, sizeof(fname_server)); |
justinkim | 4:63042b865304 | 310 | FTP_CONTROL_SOCK.send(END, sizeof(END)-1); |
justinkim | 4:63042b865304 | 311 | break; |
justinkim | 4:63042b865304 | 312 | }//end of FTPCommand.First switch case |
justinkim | 4:63042b865304 | 313 | }//end of gDataSockReady if |
justinkim | 4:63042b865304 | 314 | /* received from FTPServer */ |
justinkim | 4:63042b865304 | 315 | int n = FTP_CONTROL_SOCK.receive(buf, sizeof(buf)); |
justinkim | 4:63042b865304 | 316 | if (n <= 0) break; |
justinkim | 4:63042b865304 | 317 | buf[n] = '\0'; |
justinkim | 4:63042b865304 | 318 | pc.printf("\r\nReceived message from server: '%s'\r\n", buf); |
justinkim | 4:63042b865304 | 319 | |
justinkim | 4:63042b865304 | 320 | //buf if |
justinkim | 4:63042b865304 | 321 | if (!strncmp(buf, "220", 3)){ |
justinkim | 4:63042b865304 | 322 | FTP_CONTROL_SOCK.send(USER, sizeof(USER)-1); |
justinkim | 4:63042b865304 | 323 | FTP_CONTROL_SOCK.send(ID, sizeof(ID)); |
justinkim | 4:63042b865304 | 324 | FTP_CONTROL_SOCK.send(END, sizeof(END)-1); |
justinkim | 4:63042b865304 | 325 | } |
justinkim | 4:63042b865304 | 326 | else if(!strncmp(buf, "331", 3)){ |
justinkim | 4:63042b865304 | 327 | FTP_CONTROL_SOCK.send(PASS, sizeof(PASS)-1); |
justinkim | 4:63042b865304 | 328 | FTP_CONTROL_SOCK.send(PASSWORD, sizeof(PASSWORD)); |
justinkim | 4:63042b865304 | 329 | FTP_CONTROL_SOCK.send(END, sizeof(END)-1); |
justinkim | 4:63042b865304 | 330 | } |
justinkim | 4:63042b865304 | 331 | else if(!strncmp(buf, "230", 3)){ |
justinkim | 4:63042b865304 | 332 | FTP_CONTROL_SOCK.send(PASV, sizeof(PASV)-1); |
justinkim | 4:63042b865304 | 333 | FTP_CONTROL_SOCK.send(END, sizeof(END)-1); |
justinkim | 4:63042b865304 | 334 | FTPCommand.First = f_put; |
justinkim | 4:63042b865304 | 335 | } |
justinkim | 4:63042b865304 | 336 | else if(!strncmp(buf, "227", 3)){ |
justinkim | 4:63042b865304 | 337 | if (pportc(buf) == -1){ |
justinkim | 4:63042b865304 | 338 | pc.printf("Bad port syntax\r\n"); |
justinkim | 4:63042b865304 | 339 | } |
justinkim | 4:63042b865304 | 340 | else{ |
justinkim | 4:63042b865304 | 341 | pc.printf("Go Open Data Sock...\r\n "); |
justinkim | 4:63042b865304 | 342 | FTPClient.dsock_state = DATASOCK_READY; |
justinkim | 4:63042b865304 | 343 | } |
justinkim | 4:63042b865304 | 344 | } |
justinkim | 4:63042b865304 | 345 | else if(!strncmp(buf, "150", 3)){ |
justinkim | 4:63042b865304 | 346 | switch(FTPCommand.First){ |
justinkim | 4:63042b865304 | 347 | case f_put: |
justinkim | 4:63042b865304 | 348 | FTPCommand.First = f_nocmd; |
justinkim | 4:63042b865304 | 349 | FTPCommand.Second = s_put; |
justinkim | 4:63042b865304 | 350 | gDataPutGetStart = true; |
justinkim | 4:63042b865304 | 351 | break; |
justinkim | 4:63042b865304 | 352 | } |
justinkim | 4:63042b865304 | 353 | } |
justinkim | 4:63042b865304 | 354 | else if(!strncmp(buf, "226", 3)){ |
justinkim | 4:63042b865304 | 355 | ftpclientrun = false; |
justinkim | 4:63042b865304 | 356 | FTP_CONTROL_SOCK.close(); |
justinkim | 4:63042b865304 | 357 | }//end of buf if |
justinkim | 4:63042b865304 | 358 | |
justinkim | 4:63042b865304 | 359 | |
justinkim | 4:63042b865304 | 360 | //DATASOCK_READY if |
justinkim | 4:63042b865304 | 361 | if(FTPClient.dsock_state == DATASOCK_READY){ |
justinkim | 4:63042b865304 | 362 | while(!FTP_DATA_SOCK.is_connected()){ |
justinkim | 4:63042b865304 | 363 | pc.printf("Connecting...FTPServer Data sock\r\nIP:%s, PORT:%d\r\n", ftpServer_data_ip_addr_str, remote_port); |
justinkim | 4:63042b865304 | 364 | FTP_DATA_SOCK.connect(ftpServer_control_ip_addr, remote_port); |
justinkim | 4:63042b865304 | 365 | FTP_DATA_SOCK.set_blocking(false, 15000); // Timeout after (1.5)s |
justinkim | 4:63042b865304 | 366 | } |
justinkim | 4:63042b865304 | 367 | FTPClient.dsock_state = DATASOCK_IDLE; |
justinkim | 4:63042b865304 | 368 | gDataSockReady = true; |
justinkim | 4:63042b865304 | 369 | }//end of DATASOCK_READY if |
justinkim | 4:63042b865304 | 370 | |
justinkim | 4:63042b865304 | 371 | //gDataPutGetStart if |
justinkim | 4:63042b865304 | 372 | if(gDataPutGetStart){ |
justinkim | 4:63042b865304 | 373 | //FTPCommand.Second switch case |
justinkim | 4:63042b865304 | 374 | switch(FTPCommand.Second){ |
justinkim | 4:63042b865304 | 375 | case s_put: |
justinkim | 4:63042b865304 | 376 | pc.printf("put waiting...\r\n"); |
justinkim | 4:63042b865304 | 377 | snprintf(fname, sizeof(fname), "/sd/jpss0000.jpg"); |
justinkim | 4:63042b865304 | 378 | fp_jpeg = fopen(fname, "r"); |
justinkim | 4:63042b865304 | 379 | fseek(fp_jpeg, 0, SEEK_END); // seek to end of file |
justinkim | 4:63042b865304 | 380 | remain_filesize = ftell(fp_jpeg); // get current file pointer |
justinkim | 4:63042b865304 | 381 | fseek(fp_jpeg, 0, SEEK_SET); // seek back to beginning of file |
justinkim | 4:63042b865304 | 382 | do{ |
justinkim | 4:63042b865304 | 383 | memset(buf, 0, sizeof(buf)); |
justinkim | 4:63042b865304 | 384 | if(remain_filesize > MAX_SS) |
justinkim | 4:63042b865304 | 385 | send_byte = MAX_SS; |
justinkim | 4:63042b865304 | 386 | else |
justinkim | 4:63042b865304 | 387 | send_byte = remain_filesize; |
justinkim | 4:63042b865304 | 388 | fread (buf, 1, send_byte, fp_jpeg); |
justinkim | 4:63042b865304 | 389 | FTP_DATA_SOCK.send(buf, send_byte); |
justinkim | 4:63042b865304 | 390 | remain_filesize -= send_byte; |
justinkim | 4:63042b865304 | 391 | pc.printf("#"); |
justinkim | 4:63042b865304 | 392 | }while(remain_filesize!=0); |
justinkim | 4:63042b865304 | 393 | fclose(fp_jpeg); |
justinkim | 4:63042b865304 | 394 | gDataPutGetStart = false; |
justinkim | 4:63042b865304 | 395 | FTPCommand.Second = s_nocmd; |
justinkim | 4:63042b865304 | 396 | FTP_DATA_SOCK.close(); |
justinkim | 4:63042b865304 | 397 | break; |
justinkim | 4:63042b865304 | 398 | |
justinkim | 4:63042b865304 | 399 | }//end of FTPCommand.Second switch case |
justinkim | 4:63042b865304 | 400 | }//end of gDataPutGetStart if |
justinkim | 4:63042b865304 | 401 | }//end of while 3 |
justinkim | 4:63042b865304 | 402 | } |
justinkim | 4:63042b865304 | 403 | } |
justinkim | 4:63042b865304 | 404 | } |
justinkim | 4:63042b865304 | 405 | |
justinkim | 4:63042b865304 | 406 | char* User_Keyboard_MSG(void) |
justinkim | 4:63042b865304 | 407 | { |
justinkim | 4:63042b865304 | 408 | User_Keyboard_MSG_Cnt = 0; |
justinkim | 4:63042b865304 | 409 | memset(gMsgBuf, 0, sizeof(gMsgBuf)); |
justinkim | 4:63042b865304 | 410 | do{ |
justinkim | 4:63042b865304 | 411 | gMsgBuf[User_Keyboard_MSG_Cnt] = pc.getc(); |
justinkim | 4:63042b865304 | 412 | if(gMsgBuf[User_Keyboard_MSG_Cnt]==0x08){ |
justinkim | 4:63042b865304 | 413 | User_Keyboard_MSG_Cnt--; |
justinkim | 4:63042b865304 | 414 | } |
justinkim | 4:63042b865304 | 415 | else{ |
justinkim | 4:63042b865304 | 416 | User_Keyboard_MSG_Cnt++; |
justinkim | 4:63042b865304 | 417 | } |
justinkim | 4:63042b865304 | 418 | }while(gMsgBuf[User_Keyboard_MSG_Cnt-1]!=0x0d); |
justinkim | 4:63042b865304 | 419 | return gMsgBuf; |
justinkim | 4:63042b865304 | 420 | } |
justinkim | 4:63042b865304 | 421 | |
justinkim | 4:63042b865304 | 422 | int pportc(char * arg) |
justinkim | 4:63042b865304 | 423 | { |
justinkim | 4:63042b865304 | 424 | int i; |
justinkim | 4:63042b865304 | 425 | char* tok=0; |
justinkim | 4:63042b865304 | 426 | strtok(arg,"("); |
justinkim | 4:63042b865304 | 427 | for (i = 0; i < 4; i++) |
justinkim | 4:63042b865304 | 428 | { |
justinkim | 4:63042b865304 | 429 | if(i==0) tok = strtok(NULL,",\r\n"); |
justinkim | 4:63042b865304 | 430 | else tok = strtok(NULL,","); |
justinkim | 4:63042b865304 | 431 | ftpServer_data_ip_addr[i] = (uint8_t)atoi(tok); |
justinkim | 4:63042b865304 | 432 | if (!tok){ |
justinkim | 4:63042b865304 | 433 | pc.printf("bad pport : %s\r\n", arg); |
justinkim | 4:63042b865304 | 434 | return -1; |
justinkim | 4:63042b865304 | 435 | } |
justinkim | 4:63042b865304 | 436 | } |
justinkim | 4:63042b865304 | 437 | remote_port = 0; |
justinkim | 4:63042b865304 | 438 | for (i = 0; i < 2; i++){ |
justinkim | 4:63042b865304 | 439 | tok = strtok(NULL,",\r\n"); |
justinkim | 4:63042b865304 | 440 | remote_port <<= 8; |
justinkim | 4:63042b865304 | 441 | remote_port += atoi(tok); |
justinkim | 4:63042b865304 | 442 | if (!tok){ |
justinkim | 4:63042b865304 | 443 | pc.printf("bad pport : %s\r\n", arg); |
justinkim | 4:63042b865304 | 444 | return -1; |
justinkim | 4:63042b865304 | 445 | } |
justinkim | 4:63042b865304 | 446 | } |
justinkim | 4:63042b865304 | 447 | pc.printf("ip : %d.%d.%d.%d, port : %d\r\n", ftpServer_data_ip_addr[0], ftpServer_data_ip_addr[1], ftpServer_data_ip_addr[2], ftpServer_data_ip_addr[3], remote_port); |
justinkim | 4:63042b865304 | 448 | sprintf(ftpServer_data_ip_addr_str, "%d.%d.%d.%d", ftpServer_data_ip_addr[0], ftpServer_data_ip_addr[1], ftpServer_data_ip_addr[2], ftpServer_data_ip_addr[3]); |
justinkim | 4:63042b865304 | 449 | return 0; |
justinkim | 4:63042b865304 | 450 | } |
justinkim | 4:63042b865304 | 451 |