標題: UDP發(fā)送數(shù)據(jù)包，注意IP校驗和 [打印本頁]
作者: xuwei    時間: 2015-6-13 16:54
標題: UDP發(fā)送數(shù)據(jù)包，注意IP校驗和
  1. 費了好大勁！本來很簡單，一個校驗擦！
  2. 注意，一定要注意

  4. #include "ARP.h"
  5. #include "IP.H"
  6. #include "UDP.H"
  7. #include "ENC28J60_SPI.h"
  8. #include "ENC28J60_Send_Receive.h"
  9. #include "ENC28J60_Buff_Operation.h"
  10. #include "UART.H"
  11. /*******************************8


  14.    發(fā)送UDP數(shù)據(jù)包
  15.   指定目標IP，本地IP，本地端口，目標端口
  16.   還有數(shù)據(jù)大小，什么數(shù)據(jù)，第幾個包
  17.         uchar *MAC_Target_add,//MAC地址。一般情況下由ARP計算得出
  18.                         uchar *IP_Source_add,//IP源地址
  19.         uchar *IP_Target_add,//IP目標地址
  20.         uint   UDP_Source_Port,UDP源端口
  21.         uint   UDP_Target_Port,UDP目標端口
  22.         uchar * UDP_Send_Data, UDP數(shù)據(jù)
  23.         uchar UDP_Send_Data_length UDP數(shù)據(jù)長度
  24. **********************************/
  25. //Send_UDP_packet( ); //應答
  26. void Send_UDP_packet(   uchar *MAC_Target_add,
  27.         uchar *IP_Target_add,
  28.         uchar *UDP_Source_Port,
  29.         uchar *UDP_Target_Port,
  30.         uchar *UDP_Send_Data,
  31.         uchar UDP_Send_Data_length
  32.        )
  33. {

  35. TypeDef_MAC_Frame_H xdata  MAC_Frame_H;//MAC定義一個結構體頭
  36. TypeDef_IP_Frame_H  xdata  IP_Frame_H; //IP定義一個結構體頭
  37. TypeDef_UDP_Frame_H xdata  UDP_Frame_H;//UDP定義數(shù)據(jù)結構  
  38. xdata unsigned long a,b;
  39. xdata uchar i;
  40. xdata uint tab[10];
  41. xdata uint msb,lsb;
  42. xdata uchar  d;
  43. xdata uint da1;
  44. xdata uint da2;
  45. xdata uchar MSB_SUM,LSB_SUM;
  46. UDP_Frame_Set(&MAC_Frame_H,&IP_Frame_H,&UDP_Frame_H);//設置UDP相關參數(shù)
  47.      /*MAC目標地址*/
  48.   MAC_Frame_H.Destination_MAC[0]=MAC_Target_add[0];
  49.   MAC_Frame_H.Destination_MAC[1]=MAC_Target_add[1];
  50.   MAC_Frame_H.Destination_MAC[2]=MAC_Target_add[2];
  51.   MAC_Frame_H.Destination_MAC[3]=MAC_Target_add[3];
  52.   MAC_Frame_H.Destination_MAC[4]=MAC_Target_add[4];
  53.   MAC_Frame_H.Destination_MAC[5]=MAC_Target_add[5];
  54.      /*IP目標地址*/
  55.   IP_Frame_H.IP_Dstination[0]=IP_Target_add[0];
  56.   IP_Frame_H.IP_Dstination[1]=IP_Target_add[1];
  57.   IP_Frame_H.IP_Dstination[2]=IP_Target_add[2];
  58.   IP_Frame_H.IP_Dstination[3]=IP_Target_add[3];
  59.       //數(shù)據(jù)長度，
  60.    /*這個長度等于IP部首20字節(jié)+UDP部首8字節(jié)+UDP數(shù)據(jù)，這里是1字節(jié)*/
  61.   IP_Frame_H.IP_Total_Length[0]=0;//設置總長度
  62.   IP_Frame_H.IP_Total_Length[1]=0x1d;//設置總長度  //29字節(jié)
  63.   /*計算IP部首校驗和**/
  64.   IP_Frame_H.IP_Check_sum[0]=0;
  65.   IP_Frame_H.IP_Check_sum[1]=0; //先設置為0        
  66.    
  67.   
  68. msb=IP_Frame_H.IP_Version_Head; //IP的版本號和IP的部首長度，默認為0X45,版本是4，部首是20字節(jié)
  69.     msb=msb<<8;
  70. lsb=IP_Frame_H.IP_Tos; //ip的TOS據(jù)我抓包觀察一般是00
  71. tab[0]=msb+lsb;
  72. msb=IP_Frame_H.IP_Total_Length[0];//總數(shù)據(jù)報文長度
  73. msb=msb<<8;
  74. lsb=IP_Frame_H.IP_Total_Length[1];//總數(shù)據(jù)報文長度
  75. tab[1]=msb+lsb;
  76. msb=IP_Frame_H.IP_Indentification[0];//IP標識字段,標識字段唯一地標識主機發(fā)送的每一份數(shù)據(jù)報。通常每發(fā)送一份報文它的值就會加1
  77. msb=msb<<8;
  78. lsb=IP_Frame_H.IP_Indentification[1];
  79. tab[2]=msb+lsb;

  81.    msb=IP_Frame_H.IP_Flage_FRAGMENT_OFFSET[0];//標志位和片偏移
  82.    msb=msb<<8;
  83.    lsb=IP_Frame_H.IP_Flage_FRAGMENT_OFFSET[1];//標志位和片偏移
  84.     tab[3]=msb+lsb;
  85.     msb=IP_Frame_H.IP_TTL; //生存時間
  86.   msb=msb<<8;
  87. lsb=IP_Frame_H.IP_Protocol; //協(xié)議類型
  88. tab[4]=msb+lsb;
  89. msb=IP_Frame_H.IP_Check_sum[0];//部首校驗和
  90. msb=msb<<8;
  91. lsb=IP_Frame_H.IP_Check_sum[0];//部首校驗和
  92. tab[5]=msb+lsb;
  93.     msb=IP_Frame_H.IP_Source[0];//32IP位源地址
  94. msb=msb<<8;
  95. lsb=IP_Frame_H.IP_Source[1];//32IP位源地址
  96. tab[6]=msb+lsb;
  97. msb=IP_Frame_H.IP_Source[2];//32IP位源地址
  98. msb=msb<<8;
  99. lsb=IP_Frame_H.IP_Source[3];//32IP位源地址
  100. tab[7]=msb+lsb;
  101. msb=IP_Frame_H.IP_Dstination[0];//32位IP目標地址
  102. msb=msb<<8;
  103. lsb=IP_Frame_H.IP_Dstination[1];//32位IP目標地址
  104. tab[8]=msb+lsb;
  105. msb=IP_Frame_H.IP_Dstination[2];//32位IP目標地址
  106. msb=msb<<8;
  107. lsb=IP_Frame_H.IP_Dstination[3];//32位IP目標地址
  108. tab[9]=msb+lsb;
  109. /**我操原來是沒有清空變量草，費了我一天時間，我說第一次運行正確，其后不對
  110. 沒有清零！我擦我操！
  111. 2012年3月7日
  112. 日照高科園
  113. 王均偉*/   
  114.    a=0;
  115.    b=0;
  116.   for(i=0;i<10;i++)
  117.    {
  118.    a=a+tab[i]; //變量加
  119. b=a;//暫存A中
  120. b+=(a>>16)&0x0000ffff; //取高位與地位相加，并且加完了清0高八位
  121. }
  122.     b=~b; //取反
  123. da1=b;
  124. da2=da1;
  125. da2=(da2>>8)&0x00ff;
  126. //da=IP_Check_Sum_Verify(&IP_Frame_H); //計算IP部首校驗和
  127. LSB_SUM=da1;
  128. MSB_SUM=da2;
  129. IP_Frame_H.IP_Check_sum[0]=MSB_SUM;
  130. IP_Frame_H.IP_Check_sum[1]=LSB_SUM; //寫入IP部首校驗和


  133.   UDP_Frame_H.UDP_Source_Port[0]=UDP_Source_Port[0];
  134.   UDP_Frame_H.UDP_Source_Port[1]=UDP_Source_Port[1];//源端口是8080
  135.   UDP_Frame_H.UDP_Dstination_Port[0]=UDP_Target_Port[0];
  136.   UDP_Frame_H.UDP_Dstination_Port[1]=UDP_Target_Port[1];//目標端口是8080
  137. //for(i=0;i<UDP_Send_Data_length;i++)  //等到多數(shù)據(jù)寫入時采用的測試只發(fā)送一個字節(jié)
  138.    UDP_Frame_H.UDP_Data[0]=UDP_Send_Data[0];//數(shù)據(jù)寫入

  140. /*              物理操作            */
  141. set_send_buffer_add(0x0200,0x023f);//緩沖區(qū)的大小設定，開始200結束1fff

  143. write_buffer_add(0x0200,0x0e);//控制字節(jié)
  144. //        MAC
  145. write_buffer_add(0x0201,MAC_Frame_H.Destination_MAC[0]);//
  146. write_buffer_add(0x0202,MAC_Frame_H.Destination_MAC[1]);//
  147. write_buffer_add(0x0203,MAC_Frame_H.Destination_MAC[2]);//
  148. write_buffer_add(0x0204,MAC_Frame_H.Destination_MAC[3]);//
  149. write_buffer_add(0x0205,MAC_Frame_H.Destination_MAC[4]);//   MAC目的地址
  150. write_buffer_add(0x0206,MAC_Frame_H.Destination_MAC[5]);//
  151. write_buffer_add(0x0207, MAC_Frame_H.Source_add_MAC[0]);//
  152. write_buffer_add(0x0208, MAC_Frame_H.Source_add_MAC[1]);//
  153. write_buffer_add(0x0209, MAC_Frame_H.Source_add_MAC[2]);//  MAC源地址
  154. write_buffer_add(0x020A, MAC_Frame_H.Source_add_MAC[3]);//
  155. write_buffer_add(0x020B, MAC_Frame_H.Source_add_MAC[4]);//
  156. write_buffer_add(0x020C, MAC_Frame_H.Source_add_MAC[5]);//
  157. write_buffer_add(0x020D, MAC_Frame_H.Type[0]);//   MAC類型
  158. write_buffer_add(0x020E, MAC_Frame_H.Type[1]);//
  159.    

  161.     //IP
  162. write_buffer_add(0x020F,IP_Frame_H.IP_Version_Head);//
  163. write_buffer_add(0x0210,IP_Frame_H.IP_Tos);//
  164. write_buffer_add(0x0211,IP_Frame_H.IP_Total_Length[0]);
  165. write_buffer_add(0x0212,IP_Frame_H.IP_Total_Length[1]);
  166. write_buffer_add(0x0213,IP_Frame_H.IP_Indentification[0]);
  167. write_buffer_add(0x0214,IP_Frame_H.IP_Indentification[1]);
  168. write_buffer_add(0x0215,IP_Frame_H.IP_Flage_FRAGMENT_OFFSET[0]);
  169. write_buffer_add(0x0216,IP_Frame_H.IP_Flage_FRAGMENT_OFFSET[1]);
  170. write_buffer_add(0x0217,IP_Frame_H.IP_TTL);
  171. write_buffer_add(0x0218,IP_Frame_H.IP_Protocol);
  172. write_buffer_add(0x0219,IP_Frame_H.IP_Check_sum[0]);
  173. write_buffer_add(0x021A,IP_Frame_H.IP_Check_sum[1]);
  174. write_buffer_add(0x021B,IP_Frame_H.IP_Source[0]);
  175. write_buffer_add(0x021C,IP_Frame_H.IP_Source[1]);
  176. write_buffer_add(0x021D,IP_Frame_H.IP_Source[2]);
  177. write_buffer_add(0x021E,IP_Frame_H.IP_Source[3]);
  178. write_buffer_add(0x021F,IP_Frame_H.IP_Dstination[0]);
  179. write_buffer_add(0x0220,IP_Frame_H.IP_Dstination[1]);
  180. write_buffer_add(0x0221,IP_Frame_H.IP_Dstination[2]);
  181. write_buffer_add(0x0222,IP_Frame_H.IP_Dstination[3]);

  183.        //UDP
  184. write_buffer_add(0x0223,UDP_Frame_H.UDP_Source_Port[0]);
  185. write_buffer_add(0x0224,UDP_Frame_H.UDP_Source_Port[1]);
  186. write_buffer_add(0x0225,UDP_Frame_H.UDP_Dstination_Port[0]);
  187. write_buffer_add(0x0226,UDP_Frame_H.UDP_Dstination_Port[1]);
  188. write_buffer_add(0x0227,UDP_Frame_H.UDP_Length[0]);
  189. write_buffer_add(0x0228,UDP_Frame_H.UDP_Length[1]);
  190. write_buffer_add(0x0229,UDP_Frame_H.UDP_check_sum[0]);
  191. write_buffer_add(0x022A,UDP_Frame_H.UDP_check_sum[1]);
  192.     //數(shù)據(jù)
  193. write_buffer_add(0x022B,UDP_Frame_H.UDP_Data[0]);
  194. write_ENC28J60_REG_SPI(ECON1,0x0c);//允許發(fā)送,允許接收
  195.   for(;;)
  196.   {

  198.    d=read_ENC28J60_REG_SPI(EIR);//讀取數(shù)據(jù)包接收標志位
  199.    if((d&0x08)==0x08)break;  //發(fā)送完畢？？OK退出ifNO死在里面
  200.   
  201.      }   




  206. }
  207. /*****************************
  208. 只有接收到一個請求后才會
  209. 發(fā)送一個arp應答數(shù)據(jù)包，
  210. Receive_MAC_Source_add_MAC：源MAC，即本機MAC
  211. Receive_ARP_Frame_sender_IP ：本機IP
  212. Receive_ARP_Frame_Target_IP:目標IP
  213. ******************************/
  214. void Send_ARP_Answer_packet(uchar *Receive_MAC_Source_add_MAC,
  215.        uchar *Receive_ARP_Frame_sender_IP,
  216.        uchar *Receive_ARP_Frame_Target_IP
  217.        )
  218. {   
  219.     uchar  xdata d;
  220. TypeDef_ARP_Frame   xdata  ARP_Frame;
  221. TypeDef_MAC_Frame_H xdata  MAC_Frame_H;  //定義兩個類型結構變量
  222.   /*傳遞了兩個結構傳遞過去，設置完了在回來用
  223.   也是我頭回用結構做程序
  224.   */
  225. ARP_Frame_Set(&ARP_Frame,&MAC_Frame_H);//加載ARP數(shù)據(jù)包
  226.       /*mac目標地址*/
  227.     MAC_Frame_H.Destination_MAC[0]=*(Receive_MAC_Source_add_MAC);
  228.     MAC_Frame_H.Destination_MAC[1]=*(Receive_MAC_Source_add_MAC+1);
  229.     MAC_Frame_H.Destination_MAC[2]=*(Receive_MAC_Source_add_MAC+2);
  230.     MAC_Frame_H.Destination_MAC[3]=*(Receive_MAC_Source_add_MAC+3);
  231.     MAC_Frame_H.Destination_MAC[4]=*(Receive_MAC_Source_add_MAC+4);
  232.        MAC_Frame_H.Destination_MAC[5]=*(Receive_MAC_Source_add_MAC+5);
  233.         /*發(fā)送者IP*/
  234. ARP_Frame.sender_IP[0]=Receive_ARP_Frame_Target_IP[0];
  235. ARP_Frame.sender_IP[1]=Receive_ARP_Frame_Target_IP[1];
  236. ARP_Frame.sender_IP[2]=Receive_ARP_Frame_Target_IP[2];
  237. ARP_Frame.sender_IP[3]=Receive_ARP_Frame_Target_IP[3];
  238.       /*mac目標*/
  239. ARP_Frame.Target_MAC[0]=*(Receive_MAC_Source_add_MAC);
  240. ARP_Frame.Target_MAC[1]=*(Receive_MAC_Source_add_MAC+1);
  241. ARP_Frame.Target_MAC[2]=*(Receive_MAC_Source_add_MAC+2);
  242. ARP_Frame.Target_MAC[3]=*(Receive_MAC_Source_add_MAC+3);
  243. ARP_Frame.Target_MAC[4]=*(Receive_MAC_Source_add_MAC+4);
  244. ARP_Frame.Target_MAC[5]=*(Receive_MAC_Source_add_MAC+5);
  245.      /*目標IP*/
  246. ARP_Frame.Target_IP[0]=Receive_ARP_Frame_sender_IP[0];
  247. ARP_Frame.Target_IP[1]=Receive_ARP_Frame_sender_IP[1];
  248. ARP_Frame.Target_IP[2]=Receive_ARP_Frame_sender_IP[2];
  249. ARP_Frame.Target_IP[3]=Receive_ARP_Frame_sender_IP[3];

  251.    set_send_buffer_add(0x0200,0x023f);//緩沖區(qū)的大小設定，開始200結束1fff

  253. write_buffer_add(0x0200,0x0e);//控制字節(jié)
  254. write_buffer_add(0x0201,MAC_Frame_H.Destination_MAC[0]);//
  255. write_buffer_add(0x0202,MAC_Frame_H.Destination_MAC[1]);//
  256. write_buffer_add(0x0203,MAC_Frame_H.Destination_MAC[2]);//
  257. write_buffer_add(0x0204,MAC_Frame_H.Destination_MAC[3]);//
  258. write_buffer_add(0x0205,MAC_Frame_H.Destination_MAC[4]);//   MAC目的地址
  259. write_buffer_add(0x0206,MAC_Frame_H.Destination_MAC[5]);//
  260. write_buffer_add(0x0207, MAC_Frame_H.Source_add_MAC[0]);//
  261. write_buffer_add(0x0208, MAC_Frame_H.Source_add_MAC[1]);//
  262. write_buffer_add(0x0209, MAC_Frame_H.Source_add_MAC[2]);//  MAC源地址
  263. write_buffer_add(0x020A, MAC_Frame_H.Source_add_MAC[3]);//
  264. write_buffer_add(0x020B, MAC_Frame_H.Source_add_MAC[4]);//
  265. write_buffer_add(0x020C, MAC_Frame_H.Source_add_MAC[5]);//
  266. write_buffer_add(0x020D, MAC_Frame_H.Type[0]);//   MAC類型
  267. write_buffer_add(0x020E, MAC_Frame_H.Type[1]);//
  268.    
  269. write_buffer_add(0x020F,ARP_Frame.Hardware_type[0]);//
  270. write_buffer_add(0x0210,ARP_Frame.Hardware_type[1]);//
  271. write_buffer_add(0x0211,ARP_Frame.Protocol_type[0]);
  272. write_buffer_add(0x0212,ARP_Frame.Protocol_type[1]);
  273. write_buffer_add(0x0213,ARP_Frame.Hardware_address_length);
  274. write_buffer_add(0x0214,ARP_Frame.Protocol_address_length);
  275. write_buffer_add(0x0215,ARP_Frame.Operation_code[0]);
  276. write_buffer_add(0x0216,ARP_Frame.Operation_code[1]);
  277. write_buffer_add(0x0217,ARP_Frame.sender_MAC[0]);
  278. write_buffer_add(0x0218,ARP_Frame.sender_MAC[1]);
  279. write_buffer_add(0x0219,ARP_Frame.sender_MAC[2]);
  280. write_buffer_add(0x021A,ARP_Frame.sender_MAC[3]);
  281. write_buffer_add(0x021B,ARP_Frame.sender_MAC[4]);
  282. write_buffer_add(0x021C,ARP_Frame.sender_MAC[5]);
  283. write_buffer_add(0x021D,ARP_Frame.sender_IP[0]);
  284. write_buffer_add(0x021E,ARP_Frame.sender_IP[1]);
  285. write_buffer_add(0x021F,ARP_Frame.sender_IP[2]);
  286. write_buffer_add(0x0220,ARP_Frame.sender_IP[3]);
  287. write_buffer_add(0x0221,ARP_Frame.Target_MAC[0]);
  288. write_buffer_add(0x0222,ARP_Frame.Target_MAC[1]);
  289. write_buffer_add(0x0223,ARP_Frame.Target_MAC[2]);
  290. write_buffer_add(0x0224,ARP_Frame.Target_MAC[3]);
  291. write_buffer_add(0x0225,ARP_Frame.Target_MAC[4]);
  292. write_buffer_add(0x0226,ARP_Frame.Target_MAC[5]);
  293. write_buffer_add(0x0227,ARP_Frame.Target_IP[0]);
  294. write_buffer_add(0x0228,ARP_Frame.Target_IP[1]);
  295. write_buffer_add(0x0229,ARP_Frame.Target_IP[2]);
  296. write_buffer_add(0x022A,ARP_Frame.Target_IP[3]);
  297. write_ENC28J60_REG_SPI(ECON1,0x0c);//允許發(fā)送,允許接收
  298.   for(;;)
  299.   {

  301.    d=read_ENC28J60_REG_SPI(EIR);//讀取數(shù)據(jù)包接收標志位
  302.   //SendOneByte(d);調(diào)試
  303.    if((d&0x08)==0x08)break;  //發(fā)送完畢？？OK退出ifNO死在里面
  304.   
  305.      }   
  306.    
  307. }
復制代碼






歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1