乡下人产国偷v产偷v自拍,国产午夜片在线观看,婷婷成人亚洲综合国产麻豆,久久综合给合久久狠狠狠9

    • <output id="e9wm2"></output>
    <s id="e9wm2"><nobr id="e9wm2"><ins id="e9wm2"></ins></nobr></s> 
    

    • 
    
    
      



    
      
        
      
            
        
      
        
      
    
      
    
      
        
      
        
      
            
            
      
                
      
                    
                
      
                搜索
            
      

            分享
                
            

            
            
            
            
            
            
            
            

            
        
      
    
      
    
      

    
      

    
      
        
      
        
      
        
      
        
      
            
      
                
      
                    
      [轉(zhuǎn)]讓uboot的tftp支持上傳功能
      
                    
                    
                    
                    
      
                         敗敗0619
                        
                        
                        2012-09-11
                        
                            
                        
                    
      
                    
      
                        
                        
      
                    
      
                    
                    
      
                        
      
                            
                        
      
                        
      
                            
                                
      
                                    
                                        
      

                                        
                                        

                                        
      uboot下的tftp下載功能是非常重要和常見(jiàn)的功能。但是偶爾有些特殊需求的人需要使用uboot的tftp具有上傳功能。
      默認(rèn)的uboot沒(méi)有tftp上傳功能，如果需要修改uboot代碼。
      使用時(shí)鍵入第4個(gè)參數(shù)，則不同于3個(gè)參數(shù)的tftp下載功能。
      #tftp 50400000 xx.bin 10000
      TFTP to server 192.168.0.30; our IP address is 192.168.0.152
      Upload Filename 'xx.bin'.
      Upload from address: 0x50400000, 0.064 MB to be send ...
      Uploading: %#   [ Connected ]

               0.064 MB upload ok.
      這條命令將板子上0x50400000 開(kāi)始，長(zhǎng)度0x10000的數(shù)據(jù)上傳到遠(yuǎn)程tftp服務(wù)器，命名為xx.bin

      這個(gè)修改在uboot1.3.4和2008.10版本上測(cè)試通過(guò)。
      1、修改common/cmd_net.c 
      注釋掉
      1. /*
      2. 
int do_tftpb (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
      3. 
{
      4. 
    return netboot_common (TFTP, cmdtp, argc, argv);
      5. 
}
      6. 

      7. 
U_BOOT_CMD(
      8. 
    tftpboot,    3,    1,    do_tftpb,
      9. 
    "tftpboot- boot image via network using TFTP protocol\n",
      10. 
    "[loadAddress] [[hostIPaddr:]bootfilename]\n"
      11. 
);
      12. 
*/
      可以看出默認(rèn)uboot執(zhí)行tftp命令其實(shí)調(diào)用的是tftpboot，uboot果然是看命名的前面幾個(gè)字母而不是全名。例如print命令只需要鍵入pri。
      接著添加
      1. int do_tftp (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
      2. 
{
      3. 
    return netboot_common (TFTP, cmdtp, argc, argv);
      4. 
}
      5. 

      6. 
U_BOOT_CMD(
      7. 
    tftp,    4,    1,    do_tftp,
      8. 
    "tftp\t- download or upload image via network using TFTP protocol\n",
      9. 
    "[loadAddress] [bootfilename] <upload_size>\n"
      10. 
);
      然后修改netboot_common成如下代碼
      1. static int
      2. 
netboot_common (proto_t proto, cmd_tbl_t *cmdtp, int argc, char *argv[])
      3. 
{
      4. 
    extern ulong upload_addr;
      5. 
    extern ulong upload_size;
      6. 

      7. 
    char *s;
      8. 
    int   rcode = 0;
      9. 
    int   size;
      10. 

      11. 
    /* pre-set load_addr */
      12. 
    if ((s = getenv("loadaddr")) != NULL) {
      13. 
        load_addr = simple_strtoul(s, NULL, 16);
      14. 
    }
      15. 

      16. 
    switch (argc) {
      17. 
    case 1:
      18. 
        break;
      19. 

      20. 
    case 2:    /* only one arg - accept two forms:
      21. 
         * just load address, or just boot file name.
      22. 
         * The latter form must be written "filename" here.
      23. 
         */
      24. 
        if (argv[1][0] == '"') {    /* just boot filename */
      25. 
            copy_filename (BootFile, argv[1], sizeof(BootFile));
      26. 
        } else {            /* load address    */
      27. 
            load_addr = simple_strtoul(argv[1], NULL, 16);
      28. 
        }
      29. 
        break;
      30. 

      31. 
    case 3:    load_addr = simple_strtoul(argv[1], NULL, 16);
      32. 
        copy_filename (BootFile, argv[2], sizeof(BootFile));
      33. 
        upload_size = 0;
      34. 
        
      35. 
        break;
      36. 
    
      37. 
    case 4:
      38. 
        upload_addr = simple_strtoul(argv[1], NULL, 16);
      39. 
        upload_size = simple_strtoul(argv[3], NULL, 16);
      40. 
        copy_filename (BootFile, argv[2], sizeof(BootFile));
      41. 

      42. 
        break;
      43. 

      44. 
    default: printf ("Usage:\n%s\n", cmdtp->usage);
      45. 
        show_boot_progress (-80);
      46. 
        return 1;
      47. 
    }
      48. 

      49. 
    show_boot_progress (80);
      50. 
    if ((size = NetLoop(proto)) < 0) {
      51. 
        show_boot_progress (-81);
      52. 
        return 1;
      53. 
    }
      54. 

      55. 
    show_boot_progress (81);
      56. 
    /* NetLoop ok, update environment */
      57. 
    netboot_update_env();
      58. 

      59. 
    /* done if no file was loaded (no errors though) */
      60. 
    if (size == 0) {
      61. 
        show_boot_progress (-82);
      62. 
        return 0;
      63. 
    }
      64. 

      65. 
    /* flush cache */
      66. 
    flush_cache(load_addr, size);
      67. 

      68. 
    /* Loading ok, check if we should attempt an auto-start */
      69. 
    if (((s = getenv("autostart")) != NULL) && (strcmp(s,"yes") == 0)) {
      70. 
        char *local_args[2];
      71. 
        local_args[0] = argv[0];
      72. 
        local_args[1] = NULL;
      73. 

      74. 
        printf ("Automatic boot of image at addr 0x%08lX ...\n",
      75. 
            load_addr);
      76. 
        show_boot_progress (82);
      77. 
        rcode = do_bootm (cmdtp, 0, 1, local_args);
      78. 
    }
      79. 

      80. 
#ifdef CONFIG_AUTOSCRIPT
      81. 
    if (((s = getenv("autoscript")) != NULL) && (strcmp(s,"yes") == 0)) {
      82. 
        printf ("Running autoscript at addr 0x%08lX", load_addr);
      83. 

      84. 
        s = getenv ("autoscript_uname");
      85. 
        if (s)
      86. 
            printf (":%s ...\n", s);
      87. 
        else
      88. 
            puts (" ...\n");
      89. 

      90. 
        show_boot_progress (83);
      91. 
        rcode = autoscript (load_addr, s);
      92. 
    }
      93. 
#endif
      94. 
    if (rcode < 0)
      95. 
        show_boot_progress (-83);
      96. 
    else
      97. 
        show_boot_progress (84);
      98. 
    return rcode;
      99. 
}
      2、修改net/tftp.c 為
      1. /*
      2. 
 *	Copyright 1994, 1995, 2000 Neil Russell.
      3. 
 *	(See License)
      4. 
 *	Copyright 2000, 2001 DENX Software Engineering, Wolfgang Denk, wd@denx.de
      5. 
 */
      6. 

      7. 
#include <common.h>
      8. 
#include <command.h>
      9. 
#include <net.h>
      10. 
#include "tftp.h"
      11. 
#include "bootp.h"
      12. 

      13. 
#undef	ET_DEBUG
      14. 

      15. 
#if defined(CONFIG_CMD_NET)
      16. 

      17. 
#define WELL_KNOWN_PORT	69		/* Well known TFTP port #		*/
      18. 
#define TIMEOUT	 	1		/* Seconds to timeout for a lost pkt	*/
      19. 
#ifndef	CONFIG_NET_RETRY_COUNT
      20. 
# define TIMEOUT_COUNT	10		/* # of timeouts before giving up  */
      21. 
#else
      22. 
# define TIMEOUT_COUNT  (CONFIG_NET_RETRY_COUNT * 2)
      23. 
#endif
      24. 
					/* (for checking the image size)	*/
      25. 
#define TBLKS_PER_HASHES	64
      26. 
#define HASHES_PER_LINE		32		/* Number of "loading" hashes per line	*/
      27. 

      28. 
/*
      29. 
 *	TFTP operations.
      30. 
 */
      31. 
#define TFTP_RRQ	1
      32. 
#define TFTP_WRQ	2
      33. 
#define TFTP_DATA	3
      34. 
#define TFTP_ACK	4
      35. 
#define TFTP_ERROR	5
      36. 
#define TFTP_OACK	6
      37. 

      38. 
#define STATE_OK	0
      39. 
#define STATE_ERROR	3
      40. 
#define STATE_WRQ	6
      41. 
#define STATE_ACK	7
      42. 

      43. 
static IPaddr_t TftpServerIP;
      44. 
static int	TftpServerPort;		/* The UDP port at their end		*/
      45. 
static int	TftpOurPort;		/* The UDP port at our end		*/
      46. 
static int	TftpTimeoutCount;
      47. 
static ulong	TftpBlock;		/* packet sequence number		*/
      48. 
static ulong	TftpLastBlock;		/* last packet sequence number received */
      49. 
static ulong	TftpBlockWrap;		/* count of sequence number wraparounds */
      50. 
static ulong	TftpBlockWrapOffset;	/* memory offset due to wrapping	*/
      51. 
static int	TftpState;
      52. 

      53. 
#define STATE_RRQ	1
      54. 
#define STATE_DATA	2
      55. 
#define STATE_TOO_LARGE	3
      56. 
#define STATE_BAD_MAGIC	4
      57. 
#define STATE_OACK	5
      58. 

      59. 
#define TFTP_BLOCK_SIZE		512		    /* default TFTP block size	*/
      60. 
#define TFTP_SEQUENCE_SIZE	((ulong)(1<<16))    /* sequence number is 16 bit */
      61. 

      62. 
#define DEFAULT_NAME_LEN	(8 + 4 + 1)
      63. 
static char default_filename[DEFAULT_NAME_LEN];
      64. 

      65. 
#ifndef CONFIG_TFTP_FILE_NAME_MAX_LEN
      66. 
#define MAX_LEN 128
      67. 
#else
      68. 
#define MAX_LEN CONFIG_TFTP_FILE_NAME_MAX_LEN
      69. 
#endif
      70. 

      71. 
static char tftp_filename[MAX_LEN];
      72. 

      73. 
#ifdef CFG_DIRECT_FLASH_TFTP
      74. 
extern flash_info_t flash_info[];
      75. 
#endif
      76. 

      77. 
ulong upload_addr = CFG_LOAD_ADDR;		/* Default upLoad Address */
      78. 
ulong upload_size = 0;
      79. 

      80. 
/* 512 is poor choice for ethernet, MTU is typically 1500.
      81. 
 * Minus eth.hdrs thats 1468.  Can get 2x better throughput with
      82. 
 * almost-MTU block sizes.  At least try... fall back to 512 if need be.
      83. 
 */
      84. 
#define TFTP_MTU_BLOCKSIZE 1468
      85. 
static unsigned short TftpBlkSize=TFTP_BLOCK_SIZE;
      86. 
static unsigned short TftpBlkSizeOption=TFTP_MTU_BLOCKSIZE;
      87. 

      88. 
#ifdef CONFIG_MCAST_TFTP
      89. 
#include <malloc.h>
      90. 
#define MTFTP_BITMAPSIZE	0x1000
      91. 
static unsigned *Bitmap;
      92. 
static int PrevBitmapHole,Mapsize=MTFTP_BITMAPSIZE;
      93. 
static uchar ProhibitMcast=0, MasterClient=0;
      94. 
static uchar Multicast=0;
      95. 
extern IPaddr_t Mcast_addr;
      96. 
static int Mcast_port;
      97. 
static ulong TftpEndingBlock; /* can get 'last' block before done..*/
      98. 

      99. 
static void parse_multicast_oack(char *pkt,int len);
      100. 

      101. 
static void
      102. 
mcast_cleanup(void)
      103. 
{
      104. 
	if (Mcast_addr) eth_mcast_join(Mcast_addr, 0);
      105. 
	if (Bitmap) free(Bitmap);
      106. 
	Bitmap=NULL;
      107. 
	Mcast_addr = Multicast = Mcast_port = 0;
      108. 
	TftpEndingBlock = -1;
      109. 
}
      110. 

      111. 
#endif	/* CONFIG_MCAST_TFTP */
      112. 

      113. 
static __inline__ void
      114. 
store_block (unsigned block, uchar * src, unsigned len)
      115. 
{
      116. 
	ulong offset = block * TftpBlkSize + TftpBlockWrapOffset;
      117. 
	ulong newsize = offset + len;
      118. 
#ifdef CFG_DIRECT_FLASH_TFTP
      119. 
	int i, rc = 0;
      120. 

      121. 
	for (i=0; i<CFG_MAX_FLASH_BANKS; i++) {
      122. 
		/* start address in flash? */
      123. 
		if (flash_info[i].flash_id == FLASH_UNKNOWN)
      124. 
			continue;
      125. 
		if ((load_addr + offset >= flash_info[i].start[0]) && 
(load_addr + offset < flash_info[i].start[0] + flash_info[i].size)) {
      126. 
			rc = 1;
      127. 
			break;
      128. 
		}
      129. 
	}
      130. 

      131. 
	if (rc) { /* Flash is destination for this packet */
      132. 
		rc = flash_write ((char *)src, (ulong)(load_addr+offset), len);
      133. 
		if (rc) {
      134. 
			flash_perror (rc);
      135. 
			NetState = NETLOOP_FAIL;
      136. 
			return;
      137. 
		}
      138. 
	}
      139. 
	else
      140. 
#endif /* CFG_DIRECT_FLASH_TFTP */
      141. 
	{
      142. 
		(void)memcpy((void *)(load_addr + offset), src, len);
      143. 
	}
      144. 
#ifdef CONFIG_MCAST_TFTP
      145. 
	if (Multicast)
      146. 
		ext2_set_bit(block, Bitmap);
      147. 
#endif
      148. 

      149. 
	if (NetBootFileXferSize < newsize)
      150. 
		NetBootFileXferSize = newsize;
      151. 
}
      152. 

      153. 
static void TftpSend (void);
      154. 
static void TftpTimeout (void);
      155. 

      156. 
/**********************************************************************/
      157. 

      158. 
static void
      159. 
TftpSend (void)
      160. 
{
      161. 
	volatile uchar *	pkt;
      162. 
	volatile uchar *	xp;
      163. 
	int			len = 0;
      164. 
	int			uplen=0;
      165. 
	volatile ushort *s;
      166. 

      167. 
#ifdef CONFIG_MCAST_TFTP
      168. 
	/* Multicast TFTP.. non-MasterClients do not ACK data. */
      169. 
	if (Multicast
      170. 
	 && (TftpState == STATE_DATA)
      171. 
	 && (MasterClient == 0))
      172. 
		return;
      173. 
#endif
      174. 
	/*
      175. 
	 *	We will always be sending some sort of packet, so
      176. 
	 *	cobble together the packet headers now.
      177. 
	 */
      178. 
	pkt = NetTxPacket + NetEthHdrSize() + IP_HDR_SIZE;
      179. 

      180. 
	switch (TftpState) {
      181. 

      182. 
	case STATE_RRQ:
      183. 
	case STATE_WRQ:
      184. 
		xp = pkt;
      185. 

      186. 
		s = (ushort *)pkt;
      187. 
		if(TftpState == STATE_WRQ)
      188. 
			*s++ = htons(TFTP_WRQ);
      189. 
		else *s++ = htons(TFTP_RRQ);
      190. 
		pkt = (uchar *)s;
      191. 
		strcpy ((char *)pkt, tftp_filename);
      192. 
		pkt += strlen(tftp_filename) + 1;
      193. 
		strcpy ((char *)pkt, "octet");
      194. 
		pkt += 5 /*strlen("octet")*/ + 1;
      195. 
		strcpy ((char *)pkt, "timeout");
      196. 
		pkt += 7 /*strlen("timeout")*/ + 1;
      197. 
		sprintf((char *)pkt, "%d", TIMEOUT);
      198. 
#ifdef ET_DEBUG
      199. 
		printf("send option \"timeout %s\"\n", (char *)pkt);
      200. 
#endif
      201. 
		pkt += strlen((char *)pkt) + 1;
      202. 
		/* try for more effic. blk size */
      203. 
		if(TftpState == STATE_WRQ)
      204. 
    		pkt += sprintf((char *)pkt,"blksize%c%d%c",
      205. 
    				0,TftpBlkSizeOption,0);
      206. 
	    else
      207. 
    		pkt += sprintf((char *)pkt,"blksize%c%d%c",
      208. 
    				0,TftpBlkSizeOption,0);
      209. 

      210. 
#ifdef CONFIG_MCAST_TFTP
      211. 
		/* Check all preconditions before even trying the option */
      212. 
		if (!ProhibitMcast
      213. 
		 && (Bitmap=malloc(Mapsize))
      214. 
		 && eth_get_dev()->mcast) {
      215. 
			free(Bitmap);
      216. 
			Bitmap=NULL;
      217. 
			pkt += sprintf((char *)pkt,"multicast%c%c",0,0);
      218. 
		}
      219. 
#endif /* CONFIG_MCAST_TFTP */
      220. 
		len = pkt - xp;
      221. 
		printf("%%");
      222. 
		break;
      223. 

      224. 
	case STATE_OACK:
      225. 
#ifdef CONFIG_MCAST_TFTP
      226. 
		/* My turn!  Start at where I need blocks I missed.*/
      227. 
		if (Multicast)
      228. 
			TftpBlock=ext2_find_next_zero_bit(Bitmap,(Mapsize*8),0);
      229. 
		/*..falling..*/
      230. 
#endif
      231. 
	case STATE_DATA:
      232. 
		xp = pkt;
      233. 
		s = (ushort *)pkt;
      234. 
		*s++ = htons(TFTP_ACK);
      235. 
		*s++ = htons(TftpBlock);
      236. 
		pkt = (uchar *)s;
      237. 
		len = pkt - xp;
      238. 
		break;
      239. 

      240. 
	case STATE_TOO_LARGE:
      241. 
		xp = pkt;
      242. 
		s = (ushort *)pkt;
      243. 
		*s++ = htons(TFTP_ERROR);
      244. 
		*s++ = htons(3);
      245. 
		pkt = (uchar *)s;
      246. 
		strcpy ((char *)pkt, "File too large");
      247. 
		pkt += 14 /*strlen("File too large")*/ + 1;
      248. 
		len = pkt - xp;
      249. 
		break;
      250. 

      251. 
	case STATE_BAD_MAGIC:
      252. 
		xp = pkt;
      253. 
		s = (ushort *)pkt;
      254. 
		*s++ = htons(TFTP_ERROR);
      255. 
		*s++ = htons(2);
      256. 
		pkt = (uchar *)s;
      257. 
		strcpy ((char *)pkt, "File has bad magic");
      258. 
		pkt += 18 /*strlen("File has bad magic")*/ + 1;
      259. 
		len = pkt - xp;
      260. 
		break;
      261. 
	case STATE_ACK:
      262. 
		xp = pkt;
      263. 
		s = (ushort *)pkt;
      264. 
		*s++ = htons(TFTP_DATA);
      265. 
		*s++ = htons(TftpBlock+1);
      266. 
		pkt = (uchar *)s;
      267. 

      268. 
		uplen = (upload_size-TftpBlock*TftpBlkSize);
      269. 
		uplen = uplen > TftpBlkSize ? TftpBlkSize : uplen;
      270. 
		memcpy((void*)pkt, (const char*)upload_addr + TftpBlock*TftpBlkSize , uplen);
      271. 
		pkt += uplen;
      272. 
		len = pkt - xp;
      273. 
		break;
      274. 
	default:
      275. 
		return;
      276. 
	}
      277. 

      278. 
	NetSendUDPPacket(NetServerEther, TftpServerIP, TftpServerPort, TftpOurPort, len);
      279. 
}
      280. 

      281. 
static void tftp_show_transferd(int block, unsigned long wrap)
      282. 
{
      283. 
#define SHOW_TRANSFERD(tail) printf ("\t[%2lu.%03lu MB]%s", ((block-1)* TftpBlkSize + wrap)>>20, \
      284. 
					(((block-1) * TftpBlkSize + wrap)&0x0FFFFF)>>10, tail)
      285. 

      286. 
	if( ((block-1) & (TBLKS_PER_HASHES-1)) == 0)
      287. 
		putc('#');
      288. 

      289. 
	if( ((block-1) & (TBLKS_PER_HASHES*HASHES_PER_LINE-1)) == 0) {
      290. 
		if((block-1) ==0) {
      291. 
			if(wrap==0) {
      292. 
				puts("\t[ Connected ]\n");
      293. 
			} else {
      294. 
				SHOW_TRANSFERD(" [BlockCounter Reset]\n");
      295. 
			}
      296. 
		} else {
      297. 
			SHOW_TRANSFERD("\n");
      298. 
		}
      299. 
	}
      300. 
#undef SHOW_TRANSFERD
      301. 
}
      302. 

      303. 
static void
      304. 
TftpHandler (uchar * pkt, unsigned dest, unsigned src, unsigned len)
      305. 
{
      306. 
	ushort proto;
      307. 
	ushort *s;
      308. 
	int i;
      309. 

      310. 
	if (dest != TftpOurPort) {
      311. 
#ifdef CONFIG_MCAST_TFTP
      312. 
		if (Multicast
      313. 
		 && (!Mcast_port || (dest != Mcast_port)))
      314. 
#endif
      315. 
		return;
      316. 
	}
      317. 
	if ( !(TftpState==STATE_RRQ || TftpState==STATE_WRQ) && src != TftpServerPort) {
      318. 
		return;
      319. 
	}
      320. 

      321. 
	if (len < 2) {
      322. 
		return;
      323. 
	}
      324. 
	len -= 2;
      325. 
	/* warning: don't use increment (++) in ntohs() macros!! */
      326. 
	s = (ushort *)pkt;
      327. 
	proto = *s++;
      328. 
	pkt = (uchar *)s;
      329. 
	switch (ntohs(proto)) {
      330. 

      331. 
	case TFTP_RRQ:
      332. 
	case TFTP_WRQ:
      333. 
		break;
      334. 
	case TFTP_ACK:
      335. 
		TftpServerPort = src;
      336. 
		TftpState=STATE_ACK;
      337. 
		TftpBlock = ntohs(*(ushort *)pkt);
      338. 
		if(TftpLastBlock == TftpBlock) {
      339. 
			putc('%');
      340. 
		} else {
      341. 
			tftp_show_transferd(TftpBlock, TftpBlockWrapOffset);
      342. 
		}
      343. 
		TftpLastBlock = TftpBlock;
      344. 
		NetSetTimeout (TIMEOUT * CFG_HZ, TftpTimeout);
      345. 

      346. 
		if(TftpBlkSize*TftpBlock> upload_size )
      347. 
		{
      348. 
			NetState = NETLOOP_SUCCESS;
      349. 
			TftpState = STATE_OK;
      350. 
			printf ("\n\t %lu.%03lu MB upload ok.\n", (TftpBlockWrapOffset+upload_size)>>20,
      351. 
					((TftpBlockWrapOffset+upload_size)&0x0FFFFF)>>10);
      352. 
			break;
      353. 
		}
      354. 
		TftpSend (); /* Send ACK */
      355. 
		break;
      356. 
	default:
      357. 
		break;
      358. 

      359. 
	case TFTP_OACK:
      360. 
#ifdef ET_DEBUG
      361. 
		printf("Got OACK: %s %s\n", pkt, pkt+strlen(pkt)+1);
      362. 
#endif
      363. 
		if(TftpState == STATE_WRQ)
      364. 
		{
      365. 
			TftpState = STATE_ACK;
      366. 
			TftpBlock = 0;
      367. 
		}
      368. 
		else
      369. 
		{
      370. 
			TftpState = STATE_OACK;
      371. 
		}
      372. 
		TftpServerPort = src;
      373. 
		/*
      374. 
		 * Check for 'blksize' option.
      375. 
		 * Careful: "i" is signed, "len" is unsigned, thus
      376. 
		 * something like "len-8" may give a *huge* number
      377. 
		 */
      378. 
		for (i=0; i+8<len; i++) {
      379. 
			if (strcmp ((char*)pkt+i,"blksize") == 0) {
      380. 
				TftpBlkSize = (unsigned short)
      381. 
					simple_strtoul((char*)pkt+i+8,NULL,10);
      382. 
#ifdef ET_DEBUG
      383. 
				printf ("Blocksize ack: %s, %d\n",
      384. 
					(char*)pkt+i+8,TftpBlkSize);
      385. 
#endif
      386. 
				break;
      387. 
			}
      388. 
		}
      389. 
#ifdef CONFIG_MCAST_TFTP
      390. 
		parse_multicast_oack((char *)pkt,len-1);
      391. 
		if ((Multicast) && (!MasterClient))
      392. 
			TftpState = STATE_DATA;	/* passive.. */
      393. 
		else
      394. 
#endif
      395. 
		TftpSend (); /* Send ACK */
      396. 
		break;
      397. 
	case TFTP_DATA:
      398. 
		if (len < 2)
      399. 
			return;
      400. 
		len -= 2;
      401. 
		TftpBlock = ntohs(*(ushort *)pkt);
      402. 

      403. 
		/*
      404. 
		 * RFC1350 specifies that the first data packet will
      405. 
		 * have sequence number 1. If we receive a sequence
      406. 
		 * number of 0 this means that there was a wrap
      407. 
		 * around of the (16 bit) counter.
      408. 
		 */
      409. 
		if (TftpBlock == 0) {
      410. 
			TftpBlockWrap++;
      411. 
			TftpBlockWrapOffset += TftpBlkSize * TFTP_SEQUENCE_SIZE;
      412. 
			printf ("\n\t %lu MB received\n\t ", TftpBlockWrapOffset>>20);
      413. 
		} else {
      414. 
#if 0
      415. 
			if (((TftpBlock - 1) % 10) == 0) {
      416. 
				putc ('#');
      417. 
			} else if ((TftpBlock % (10 * HASHES_PER_LINE)) == 0) {
      418. 
				puts ("\n\t ");
      419. 
			}
      420. 
#endif
      421. 
            tftp_show_transferd(TftpBlock, TftpBlockWrapOffset);
      422. 
		}
      423. 

      424. 
#ifdef ET_DEBUG
      425. 
		if (TftpState == STATE_RRQ) {
      426. 
			puts ("Server did not acknowledge timeout option!\n");
      427. 
		}
      428. 
#endif
      429. 

      430. 
		if (TftpState == STATE_RRQ || TftpState == STATE_OACK) {
      431. 
			/* first block received */
      432. 
			TftpState = STATE_DATA;
      433. 
			TftpServerPort = src;
      434. 
			TftpLastBlock = 0;
      435. 
			TftpBlockWrap = 0;
      436. 
			TftpBlockWrapOffset = 0;
      437. 

      438. 
#ifdef CONFIG_MCAST_TFTP
      439. 
			if (Multicast) { /* start!=1 common if mcast */
      440. 
				TftpLastBlock = TftpBlock - 1;
      441. 
			} else
      442. 
#endif
      443. 
			if (TftpBlock != 1) {	/* Assertion */
      444. 
				printf ("\nTFTP error: "
      445. 
					"First block is not block 1 (%ld)\n"
      446. 
					"Starting again\n\n",
      447. 
					TftpBlock);
      448. 
				NetStartAgain ();
      449. 
				break;
      450. 
			}
      451. 
		}
      452. 

      453. 
		if (TftpBlock == TftpLastBlock) {
      454. 
			/*
      455. 
			 *	Same block again; ignore it.
      456. 
			 */
      457. 
			putc ('%');
      458. 
			break;
      459. 
		}
      460. 

      461. 
		TftpLastBlock = TftpBlock;
      462. 
		NetSetTimeout (TIMEOUT * CFG_HZ, TftpTimeout);
      463. 

      464. 
		store_block (TftpBlock - 1, pkt + 2, len);
      465. 

      466. 
		/*
      467. 
		 *	Acknoledge the block just received, which will prompt
      468. 
		 *	the server for the next one.
      469. 
		 */
      470. 
#ifdef CONFIG_MCAST_TFTP
      471. 
		/* if I am the MasterClient, actively calculate what my next
      472. 
		 * needed block is; else I'm passive; not ACKING
      473. 
		 */
      474. 
		if (Multicast) {
      475. 
			if (len < TftpBlkSize)  {
      476. 
				TftpEndingBlock = TftpBlock;
      477. 
			} else if (MasterClient) {
      478. 
				TftpBlock = PrevBitmapHole =
      479. 
					ext2_find_next_zero_bit(
      480. 
						Bitmap,
      481. 
						(Mapsize*8),
      482. 
						PrevBitmapHole);
      483. 
				if (TftpBlock > ((Mapsize*8) - 1)) {
      484. 
					printf ("tftpfile too big\n");
      485. 
					/* try to double it and retry */
      486. 
					Mapsize<<=1;
      487. 
					mcast_cleanup();
      488. 
					NetStartAgain ();
      489. 
					return;
      490. 
				}
      491. 
				TftpLastBlock = TftpBlock;
      492. 
			}
      493. 
		}
      494. 
#endif
      495. 
		TftpSend ();
      496. 

      497. 
#ifdef CONFIG_MCAST_TFTP
      498. 
		if (Multicast) {
      499. 
			if (MasterClient && (TftpBlock >= TftpEndingBlock)) {
      500. 
				puts ("\nMulticast tftp done\n");
      501. 
				mcast_cleanup();
      502. 
				NetState = NETLOOP_SUCCESS;
      503. 
			}
      504. 
		}
      505. 
		else
      506. 
#endif
      507. 
		if (len < TftpBlkSize) {
      508. 
			/*
      509. 
			 *	We received the whole thing.  Try to
      510. 
			 *	run it.
      511. 
			 */
      512. 
			printf ("\n\t %lu.%03lu MB download ok.\n", ((TftpBlock-1)* TftpBlkSize + TftpBlockWrapOffset)>>20,
      513. 
					(((TftpBlock-1) * TftpBlkSize + TftpBlockWrapOffset)&0x0FFFFF)>>10);
      514. 
			puts ("\ndone\n");
      515. 
			NetState = NETLOOP_SUCCESS;
      516. 
		}
      517. 
		break;
      518. 

      519. 
	case TFTP_ERROR:
      520. 
		printf ("\nTFTP error: '%s' (%d)\n",
      521. 
					pkt + 2, ntohs(*(ushort *)pkt));
      522. 
		puts ("Starting again\n\n");
      523. 
#ifdef CONFIG_MCAST_TFTP
      524. 
		mcast_cleanup();
      525. 
#endif
      526. 
		NetStartAgain ();
      527. 
		break;
      528. 
	}
      529. 
}
      530. 

      531. 

      532. 
static void
      533. 
TftpTimeout (void)
      534. 
{
      535. 
	if (++TftpTimeoutCount > TIMEOUT_COUNT) {
      536. 
		puts ("\nRetry count exceeded; starting again\n");
      537. 
#ifdef CONFIG_MCAST_TFTP
      538. 
		mcast_cleanup();
      539. 
#endif
      540. 
		NetStartAgain ();
      541. 
	} else {
      542. 
		puts ("T ");
      543. 
		NetSetTimeout (TIMEOUT * CFG_HZ, TftpTimeout);
      544. 
		TftpSend ();
      545. 
	}
      546. 
}
      547. 

      548. 

      549. 
void
      550. 
TftpStart (void)
      551. 
{
      552. 
#ifdef CONFIG_TFTP_PORT
      553. 
	char *ep;             /* Environment pointer */
      554. 
#endif
      555. 

      556. 
	if(upload_size)
      557. 
		TftpState = STATE_WRQ;
      558. 
	else TftpState = STATE_RRQ;
      559. 

      560. 
	TftpServerIP = NetServerIP;
      561. 
	if (BootFile[0] == '\0') {
      562. 
		sprintf(default_filename, "%02lX%02lX%02lX%02lX.img",
      563. 
			NetOurIP & 0xFF,
      564. 
			(NetOurIP >>  8) & 0xFF,
      565. 
			(NetOurIP >> 16) & 0xFF,
      566. 
			(NetOurIP >> 24) & 0xFF	);
      567. 

      568. 
		strncpy(tftp_filename, default_filename, MAX_LEN);
      569. 
		tftp_filename[MAX_LEN-1] = 0;
      570. 

      571. 
		printf ("*** Warning: no boot file name; using '%s'\n",
      572. 
			tftp_filename);
      573. 
	} else {
      574. 
		char *p = strchr (BootFile, ':');
      575. 

      576. 
		if (p == NULL) {
      577. 
			strncpy(tftp_filename, BootFile, MAX_LEN);
      578. 
			tftp_filename[MAX_LEN-1] = 0;
      579. 
		} else {
      580. 
			*p++ = '\0';
      581. 
			TftpServerIP = string_to_ip (BootFile);
      582. 
			strncpy(tftp_filename, p, MAX_LEN);
      583. 
			tftp_filename[MAX_LEN-1] = 0;
      584. 
		}
      585. 
	}
      586. 

      587. 
#if defined(CONFIG_NET_MULTI)
      588. 
	printf ("Using %s device\n", eth_get_name());
      589. 
#endif
      590. 
	if( TftpState == STATE_WRQ)
      591. 
	{
      592. 
		puts ("TFTP to server ");	print_IPaddr (NetServerIP);
      593. 
	}
      594. 
	else
      595. 
	{
      596. 
	puts ("TFTP from server ");	print_IPaddr (TftpServerIP);
      597. 
	}
      598. 
	puts ("; our IP address is ");	print_IPaddr (NetOurIP);
      599. 

      600. 
	/* Check if we need to send across this subnet */
      601. 
	if (NetOurGatewayIP && NetOurSubnetMask) {
      602. 
	    IPaddr_t OurNet	= NetOurIP    & NetOurSubnetMask;
      603. 
	    IPaddr_t ServerNet	= TftpServerIP & NetOurSubnetMask;
      604. 

      605. 
	    if (OurNet != ServerNet) {
      606. 
		puts ("; sending through gateway ");
      607. 
		print_IPaddr (NetOurGatewayIP) ;
      608. 
	    }
      609. 
	}
      610. 
	putc ('\n');
      611. 

      612. 
	if( TftpState == STATE_WRQ)
      613. 
		printf ("Upload Filename '%s'.", tftp_filename);
      614. 
	else printf ("Download Filename '%s'.", tftp_filename);
      615. 

      616. 
	if (NetBootFileSize) {
      617. 
		printf (" Size is 0x%x Bytes = ", NetBootFileSize<<9);
      618. 
		print_size (NetBootFileSize<<9, "");
      619. 
	}
      620. 

      621. 
	putc ('\n');
      622. 

      623. 
	if( TftpState == STATE_WRQ)
      624. 
	{
      625. 
		printf ("Upload from address: 0x%lx, ", upload_addr);
      626. 
		printf ("%lu.%03lu MB to be send ...\n", upload_size>>20, (upload_size&0x0FFFFF)>>10);
      627. 
		printf ("Uploading: *\b");
      628. 
	}
      629. 
	else
      630. 
	{
      631. 
		printf ("Download to address: 0x%lx\n", load_addr);
      632. 
		printf ("Downloading: *\b");
      633. 
	}
      634. 

      635. 
	NetSetTimeout (TIMEOUT * CFG_HZ, TftpTimeout);
      636. 
	NetSetHandler (TftpHandler);
      637. 

      638. 
	TftpServerPort = WELL_KNOWN_PORT;
      639. 
	TftpTimeoutCount = 0;
      640. 
	/* Use a pseudo-random port unless a specific port is set */
      641. 
	TftpOurPort = 1024 + (get_timer(0) % 3072);
      642. 

      643. 
#ifdef CONFIG_TFTP_PORT
      644. 
	if ((ep = getenv("tftpdstp")) != NULL) {
      645. 
		TftpServerPort = simple_strtol(ep, NULL, 10);
      646. 
	}
      647. 
	if ((ep = getenv("tftpsrcp")) != NULL) {
      648. 
		TftpOurPort= simple_strtol(ep, NULL, 10);
      649. 
	}
      650. 
#endif
      651. 
	TftpBlock = 0;
      652. 

      653. 
	TftpLastBlock = 0;
      654. 
	TftpBlockWrap = 0;
      655. 
	TftpBlockWrapOffset = 0;
      656. 

      657. 
	/* zero out server ether in case the server ip has changed */
      658. 
	memset(NetServerEther, 0, 6);
      659. 
	/* Revert TftpBlkSize to dflt */
      660. 
	TftpBlkSize = TFTP_BLOCK_SIZE;
      661. 
#ifdef CONFIG_MCAST_TFTP
      662. 
	mcast_cleanup();
      663. 
#endif
      664. 

      665. 
	TftpSend ();
      666. 
}
      667. 

      668. 
#ifdef CONFIG_MCAST_TFTP
      669. 
/* Credits: atftp project.
      670. 
 */
      671. 

      672. 
/* pick up BcastAddr, Port, and whether I am [now] the master-client. *
      673. 
 * Frame:
      674. 
 *    +-------+-----------+---+-------~~-------+---+
      675. 
 *    |  opc  | multicast | 0 | addr, port, mc | 0 |
      676. 
 *    +-------+-----------+---+-------~~-------+---+
      677. 
 * The multicast addr/port becomes what I listen to, and if 'mc' is '1' then
      678. 
 * I am the new master-client so must send ACKs to DataBlocks.  If I am not
      679. 
 * master-client, I'm a passive client, gathering what DataBlocks I may and
      680. 
 * making note of which ones I got in my bitmask.
      681. 
 * In theory, I never go from master->passive..
      682. 
 * .. this comes in with pkt already pointing just past opc
      683. 
 */
      684. 
static void parse_multicast_oack(char *pkt, int len)
      685. 
{
      686. 
 int i;
      687. 
 IPaddr_t addr;
      688. 
 char *mc_adr, *port,  *mc;
      689. 

      690. 
	mc_adr=port=mc=NULL;
      691. 
	/* march along looking for 'multicast\0', which has to start at least
      692. 
	 * 14 bytes back from the end.
      693. 
	 */
      694. 
	for (i=0;i<len-14;i++)
      695. 
		if (strcmp (pkt+i,"multicast") == 0)
      696. 
			break;
      697. 
	if (i >= (len-14)) /* non-Multicast OACK, ign. */
      698. 
		return;
      699. 

      700. 
	i+=10; /* strlen multicast */
      701. 
	mc_adr = pkt+i;
      702. 
	for (;i<len;i++) {
      703. 
		if (*(pkt+i) == ',') {
      704. 
			*(pkt+i) = '\0';
      705. 
			if (port) {
      706. 
				mc = pkt+i+1;
      707. 
				break;
      708. 
			} else {
      709. 
				port = pkt+i+1;
      710. 
			}
      711. 
		}
      712. 
	}
      713. 
	if (!port || !mc_adr || !mc ) return;
      714. 
	if (Multicast && MasterClient) {
      715. 
		printf ("I got a OACK as master Client, WRONG!\n");
      716. 
		return;
      717. 
	}
      718. 
	/* ..I now accept packets destined for this MCAST addr, port */
      719. 
	if (!Multicast) {
      720. 
		if (Bitmap) {
      721. 
			printf ("Internal failure! no mcast.\n");
      722. 
			free(Bitmap);
      723. 
			Bitmap=NULL;
      724. 
			ProhibitMcast=1;
      725. 
			return ;
      726. 
		}
      727. 
		/* I malloc instead of pre-declare; so that if the file ends
      728. 
		 * up being too big for this bitmap I can retry
      729. 
		 */
      730. 
		if (!(Bitmap = malloc (Mapsize))) {
      731. 
			printf ("No Bitmap, no multicast. Sorry.\n");
      732. 
			ProhibitMcast=1;
      733. 
			return;
      734. 
		}
      735. 
		memset (Bitmap,0,Mapsize);
      736. 
		PrevBitmapHole = 0;
      737. 
		Multicast = 1;
      738. 
	}
      739. 
	addr = string_to_ip(mc_adr);
      740. 
	if (Mcast_addr != addr) {
      741. 
		if (Mcast_addr)
      742. 
			eth_mcast_join(Mcast_addr, 0);
      743. 
		if (eth_mcast_join(Mcast_addr=addr, 1)) {
      744. 
			printf ("Fail to set mcast, revert to TFTP\n");
      745. 
			ProhibitMcast=1;
      746. 
			mcast_cleanup();
      747. 
			NetStartAgain();
      748. 
		}
      749. 
	}
      750. 
	MasterClient = (unsigned char)simple_strtoul((char *)mc,NULL,10);
      751. 
	Mcast_port = (unsigned short)simple_strtoul(port,NULL,10);
      752. 
	printf ("Multicast: %s:%d [%d]\n", mc_adr, Mcast_port, MasterClient);
      753. 
	return;
      754. 
}
      755. 

      756. 
#endif /* Multicast TFTP */
      757. 

      758. 
#endif
      
                                          		
                                
      
                                  
                        
      
                    
      



                
      
                
      
                    
                    
                        
      
                            
                                
        
                                    		
                        
        
                            
                
        
                
        
                
                
                
        
                
        


                

                
        本站是提供個(gè)人知識(shí)管理的網(wǎng)絡(luò)存儲(chǔ)空間，所有內(nèi)容均由用戶(hù)發(fā)布，不代表本站觀點(diǎn)。請(qǐng)注意甄別內(nèi)容中的聯(lián)系方式、誘導(dǎo)購(gòu)買(mǎi)等信息，謹(jǐn)防詐騙。如發(fā)現(xiàn)有害或侵權(quán)內(nèi)容，請(qǐng)點(diǎn)擊一鍵舉報(bào)。
        
                
                

                
        
                    轉(zhuǎn)藏
                    
                    
                    
                    
                    
                    
                        分享
                        
                        
                    
                    獻(xiàn)花（0）
                            
                
        
                
                
                
        
                    
        
                        
                        
                    
        
                
        

            
        

            
        

            
        
                
                
                
        
                
        
                    
        
                        
        0條評(píng)論
        
                        
                        
                        
        
                            
                            
        
                                發(fā)表
                            
        
                        
        
                        
                    
        
                    
                    
        請(qǐng)遵守用戶(hù) 評(píng)論公約
        
                    
                    
          
                    
        
                    
        
                    
        
                    
                
        
               
                
        
                    
        
                        類(lèi)似文章
                        更多