开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > 通讯/手机编程 > USB编程 > 查看源码
chap_9.c
资源名称：USB_2.0.rar　[点击查看]
上传用户：ids068
上传日期：2013-04-04
资源大小：639k
文件大小：32k
源码类别：

USB编程

开发平台：

C/C++

chap_9.c：源码内容
  1. /****************************************Copyright (c)**************************************************
  2. **                               广州周立功单片机发展有限公司
  3. **                                     研    究    所
  4. **                                 http://www.zlgmcu.com
  5. **--------------当前版本修订------------------------------------------------------------------------------
  6. ** 修改人: 刘英斌
  7. ** 日　期:2003-03-13
  8. ** 描　述:ISP1581 V1.0
  9. **------------------------------------------------------------------------------------------------------
  10. ********************************************************************************************************/
  12. #include "standard.h"
  13. #include "Kernel.h"
  14. #include "D14.h"
  15. #include "usb.h"
  17. extern volatile D14_CNTRL_REG xdata D14_Cntrl_Reg;
  18. extern void Init_D14(void);
  19. extern UC code Standard_Device_Descriptor[];
  20. extern UC code Bulk_Interface_Descriptor[];
  21. extern UC code Iso_Interface_Descriptor[];
  22. extern UC code Standard_Config_Descriptor[];
  23. extern UC code Standard_Manufacturer_String[];
  24. extern UC code Standard_Product_String[];
  25. extern UC code Standard_String_ID[];
  26. extern UC code Bulk_In_Descriptor[];
  27. extern UC code Bulk_Out_Descriptor[];
  28. extern UC code Int_In_Descriptor[];
  29. extern UC code Int_Out_Descriptor[];
  30. extern UC code Iso_In_Descriptor[];
  31. extern UC code Iso_Out_Descriptor[];
  32. extern UC code Iso_In_Zero_Descriptor[];
  33. extern UC code Iso_Out_Zero_Descriptor[];
  34. extern UC code HS_Device_Descriptor[];
  35. extern UC code HS_Device_Qualifier[];
  36. extern UC code HS_Bulk_Interface_Descriptor[];
  37. extern UC code HS_Bulk_In_Descriptor[];
  38. extern UC code HS_Bulk_Out_Descriptor[];
  39. extern UC code HS_Int_In_Descriptor[];
  40. extern UC code HS_Int_Out_Descriptor[];
  41. extern UC code Other_Speed_Config_Descriptor[];
  42. extern UI count;
  43. extern void Start_mSEC_Timer(Data);
  44. extern void Start_SEC_Timer(Data);
  45. extern void Check_Busy(void);
  46. extern void TaskFile_Update(void);
  47. extern UI Temp;
  48. extern UC Device_Config_Value;
  49. extern KERNEL Kernel_Flag;
  50. extern DMA_INT_FLAG DMA_Int_Flag;
  51. extern USB_INT_FLAG USB_Int_Flag;
  52. extern USBCBW USB_CBW;
  53. extern void Init_Device(void);
  54. extern UC code Test_Packet[];
  55. extern void Init_Endpoint(void);
  56. extern void Init_Device(void);
  57. extern void Set_USB(void);
  59. //***********************************************************************
  60. //*                *
  61. //*                  Prototype Routine Definition      *
  62. //*                *
  63. //***********************************************************************
  65. void USB_Setup(void);
  66. void reserved(void);
  67. void Send_Device_Status(void);
  68. void Send_Interface_Status(void);
  69. void Send_Endpoint_Status(void);
  71. void Vendor_Specific_Command(void);
  72. void Send_Status(unsigned char tran_status);
  74. void Set_Interface_Value(void);
  75. void Get_Interface_Value(void);
  76. void Process_Synch_Frame(void);
  78. void get_status(void);
  79. void clear_feature(void);
  80. void set_feature(void);
  81. void set_address(void);
  82. void get_descriptor(void);
  83. void get_config(void);
  84. void set_config(void);
  85. void get_interface(void);
  86. void set_interface(void);
  88. void Set_Descriptor(void);
  89. void reserved(void);
  91. void ep0in_ack(void);
  92. void ep0out_ack(void);
  93. void wait_ep0tx(void);
  94. void wait_ep0rx(void);
  95. unsigned int read_endpoint(unsigned char endp,unsigned int len,unsigned char *buf);
  96. unsigned int write_endpoint(unsigned char endp,unsigned int len,unsigned char *buf);
  100. //***********************************************************************
  101. //*                *
  102. //*                      Variable Definition        *
  103. //*                *
  104. //***********************************************************************
  106. USB_INT_FLAG  USB_Int_Flag;
  107. USB_DEVICE_REQ idata USB_Device_Request;
  108. USB_DEVICE USB_Device;
  110. UC code *Descriptor_Ptr;
  112. UC idata Endpt_FIFO[MAX_BUF];
  113. UI FIFO_Count;
  114. UC VID[2],PID[2];
  115. FILESIZE FileSize;
  116. UI PIO_Count;
  117. UC File_Number;
  118. UC Current_File;
  119. ULI bytecount;
  121. //USB标准请求
  122. code void (*StandardDeviceRequest[])(void) =
  123. {
  124. get_status,
  125. clear_feature,
  126. reserved,
  127. set_feature,
  128. reserved,
  129. set_address,
  130. get_descriptor,
  131. reserved,
  132. get_config,
  133. set_config,
  134. get_interface,
  135. set_interface,
  136. reserved,
  137. reserved,
  138. reserved,
  139. reserved
  140. };
  144. //***********************************************************************
  145. //*                *
  146. //*                      Routine Definition    *
  147. //*                *
  148. //***********************************************************************
  150. //***********************************************************************
  151. //*                     *
  152. //* Routine  :  USB Debug Mode                                     *
  153. //* Input :  USB Interrupt Register           *
  154. //* Output :  None                                    *
  155. //* Function :  Branch to respective ISR                      *
  156. //*                *
  157. //***********************************************************************
  159. void USB_Debug_Mode(void)
  160. {
  161. //端点0接收到setup包处理      
  162.     if(USB_Int_Flag.BITS.EP0SETUP)
  163. {
  164. EA_DISABLE;
  165. USB_Setup();
  166. EA_ENABLE;
  167. }
  169. //挂起处理
  170. if(USB_Int_Flag.BITS.SUSP)
  171. {
  172. //清除挂起标志
  173. EA_DISABLE;
  174. USB_Int_Flag.BITS.SUSP = 0;
  175. EA_ENABLE;
  176. //ISP1581进入挂起状态           
  177. D14_Cntrl_Reg.D14_MODE.BITS.GOSUSP = 1;
  178. D14_Cntrl_Reg.D14_MODE.BITS.GOSUSP = 0;
  179. }
  181. //挂起恢复处理
  182. if(USB_Int_Flag.BITS.RESUME)
  183. {
  184. //清除恢复标志
  185. EA_DISABLE;
  186. USB_Int_Flag.BITS.RESUME = 0;         
  187. EA_ENABLE;
  188. //产生一个恢复信号
  189. D14_Cntrl_Reg.D14_MODE.BITS.SNDRSU = 1;
  190. D14_Cntrl_Reg.D14_MODE.BITS.SNDRSU = 0;
  191.     }
  193. //高速状态
  194. if(USB_Int_Flag.BITS.HS_STAT)
  195. {
  196. //清除高速状态标志
  197. EA_DISABLE;
  198. USB_Int_Flag.BITS.HS_STAT = 0;
  199. EA_ENABLE;
  200. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  201. {
  202. //切换高速指示
  203. HS_FS_LED = HIGH_SPEED_LED;
  204. //设置高速模式状态
  205. Kernel_Flag.BITS.HS_FS_State = HIGH_SPEED;
  206. //重新配置高速端点
  207. Init_Endpoint();
  209. // PIO_Count = 64;
  210. PIO_Count = 512;
  211. }
  212. }
  213. }
  216. //***********************************************************************
  217. //*      *
  218. //* Routine  :                                                 *
  219. //* Input : None                    *
  220. //* Output : None                                 *
  221. //* Function :                                             *
  222. //* *
  223. //***********************************************************************
  224. //建立包处理
  225. void USB_Setup(void)
  226. {
  227. unsigned char type, req;
  229. //清除EP0SETUP中断标志
  230. USB_Int_Flag.BITS.EP0SETUP = 0;   
  231. //清除总线复位标志
  232.     Kernel_Flag.BITS.Bus_Reset = 0;
  233. //选择端点0SETUP缓冲区
  234. D14_Cntrl_Reg.D14_ENDPT_INDEX = 0x20;
  236. //读取USB请求
  237. //读取请求类型
  238. USB_Device_Request.bmRequestType =  D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  239. //读取请求号
  240. USB_Device_Request.bRequest = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  241. //读取16bit请求数据
  242. USB_Device_Request.wValue = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  243. USB_Device_Request.wValue <<= 8;
  244. USB_Device_Request.wValue |= D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  245. //读取16bit请求索引
  246. USB_Device_Request.wIndex = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  247. USB_Device_Request.wIndex <<= 8;
  248. USB_Device_Request.wIndex |= D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  249. //读取16bit长度
  250. USB_Device_Request.wLength = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  251. USB_Device_Request.wLength <<= 8;
  252. USB_Device_Request.wLength |= D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  254. //长度处理(高低8位对调)
  255. Temp = USB_Device_Request.wLength;
  256. USB_Device_Request.wLength = 0;
  257. USB_Device_Request.wLength = (UC) Temp;
  258. USB_Device_Request.wLength <<= 8;
  259. Temp >>= 8;
  260. USB_Device_Request.wLength |= Temp;
  262. type = USB_Device_Request.bmRequestType & 0x60;
  263. req = USB_Device_Request.bRequest & 0x0f;
  265. //厂商请求
  266. if (type == 0x40)
  267. {
  268. Vendor_Specific_Command();//厂商请求处理
  269. }
  270. else if (type == 0x00)
  271. (*StandardDeviceRequest[req])();//调用标准请求
  272. }
  274. //***********************************************************************
  275. //*      *
  276. //* Routine  :                                                 *
  277. //* Input : None                    *
  278. //* Output : None                                 *
  279. //* Function :                                             *
  280. //* *
  281. //***********************************************************************
  282. //厂商请求处理
  283. void Vendor_Specific_Command(void)
  284. {
  285. if(USB_Device_Request.bRequest == 0x0C)
  286. {
  287. switch (USB_Device_Request.wIndex)
  288. {
  289. case GET_FIRMWARE_VERSION  ://获取固件版本
  290. if(USB_Device_Request.wLength == 1)
  291. {
  292. //select endpoint
  293. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  294. //set the data length to 1 byte
  295. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = 1;
  296. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  297. //sent 0x21 as data
  298. D14_Cntrl_Reg.D14_DATA_PORT_LSB = 0x22;//版本号
  299. wait_ep0tx();
  300. ep0out_ack();
  301. // ep0in_ack();
  302. break;
  303. }
  305. case SETUP_DMA_REQUEST :
  306. //Out Token Ack detected
  307. wait_ep0rx();
  308. D14_Cntrl_Reg.D14_ENDPT_INDEX = 0;
  309. //
  310. FileSize.Size.Address[0] = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  311. FileSize.Size.Address[1] = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  312. FileSize.Size.Address[2] = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  313. //读取传输字节数
  314. Temp = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  315. bytecount = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  316. bytecount <<= 8;
  317. bytecount |= Temp;
  318. //读取传输方式
  319. FileSize.Size.DIR = D14_Cntrl_Reg.D14_DATA_PORT_LSB;
  320. ep0in_ack();
  321. Kernel_Flag.BITS.Transfer_Start = 1;//标志传输数据开始
  322. break;
  324. default :
  325. if(USB_Device_Request.bmRequestType == 0xC0)
  326. {
  327. ep0in_ack();
  328. break;
  329. }
  330. if(USB_Device_Request.bmRequestType == 0x40)
  331. {
  332. D14_Cntrl_Reg.D14_ENDPT_INDEX = 0;
  333. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  334. while(!USB_Int_Flag.BITS.EP0SETUP)
  335. {
  336. //读取ISP1581中断寄存器
  337. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  338. //回写ISP1581中断寄存器
  339. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  340. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  341. return;
  342. }
  343. USB_Int_Flag.BITS.EP0TX = 0;
  344. break;
  345. }
  346. }
  347. }
  348. }
  350. //***********************************************************************
  351. //*      *
  352. //* Routine  :                                                 *
  353. //* Input : None                    *
  354. //* Output : None                                 *
  355. //* Function :                                             *
  356. //* *
  357. //***********************************************************************
  359. void reserved(void)
  360. {
  361. }
  364. //Get_Descriptor()获取描述符
  365. void get_descriptor(void)
  366. {
  368. switch(USB_Device_Request.wValue)
  369. {
  370. case  1://设备描述符
  371. //选择描述符
  372. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  373. Descriptor_Ptr = &Standard_Device_Descriptor[0]; //set pointer to device descriptor
  374. if(Kernel_Flag.BITS.HS_FS_State == HIGH_SPEED)
  375. Descriptor_Ptr = &HS_Device_Descriptor[0]; //set pointer to device descriptor
  376. count = *Descriptor_Ptr; //read in descriptor length
  377. //选择端点号
  378. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  379. //写下发送字节数
  380. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = 0x12;
  381. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  382. //send descriptor
  383. //发送描述符
  384. while(count != 0)
  385. {
  386. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  387. count--;
  388. Descriptor_Ptr++;
  389. }
  390. wait_ep0tx();
  391. ep0out_ack();
  392. break;
  394. case  2        :  //获取配置描述符
  395. USB_Int_Flag.BITS.EP0RX = 0;
  396. Temp = 64;
  397. Descriptor_Ptr = &Standard_Config_Descriptor[0]; //set pointer to configuration descriptor
  398. count = *Descriptor_Ptr; //get configuration Descriptor length
  399. //选择端点号1
  400. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  401. //check if only configuration descriptor required
  402. //检查描述符长度,决定是只发送配置描述符还是描述符集合
  403. if(count >= USB_Device_Request.wLength) //Send only Configuration descriptor
  404. {
  405. //写入发送字节数
  406. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (UC) USB_Device_Request.wLength;
  407. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = (UC) (USB_Device_Request.wLength >> 8);
  408. //send descriptor
  409. //发送描述符
  410. for(count = 0 ; count < USB_Device_Request.wLength ; count++)
  411. {
  412. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  413. Descriptor_Ptr++;
  414. }
  415. wait_ep0tx();
  416. ep0out_ack();
  417. }
  418. else //send Configuration,Interface and Endpoint descriptor
  419. {
  420. //发送描述符集合(配置+接口+端点)
  421. if(USB_Device_Request.wLength >= 32)
  422. {
  423. //写入配置描述符
  424. while(count != 0)
  425. {
  426. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  427. count--;
  428. Descriptor_Ptr++;
  429. }
  430. //选择高速还是全速接口描述符
  431. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  432. Descriptor_Ptr = &Bulk_Interface_Descriptor[0]; //set pointer to interface descriptor
  433. if(Kernel_Flag.BITS.HS_FS_State == HIGH_SPEED)
  434. Descriptor_Ptr = &HS_Bulk_Interface_Descriptor[0]; //set pointer to interface descriptor
  435. count = *Descriptor_Ptr; //get the descriptor count
  436. //写入接口描述符
  437. while(count != 0)
  438. {
  439. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  440. count--;
  441. Descriptor_Ptr++;
  442. }
  443. //选择高速还是全速端点1IN描述符
  444. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  445. Descriptor_Ptr = &Int_In_Descriptor[0]; //set pointer to interface descriptor
  446. if(Kernel_Flag.BITS.HS_FS_State == HIGH_SPEED)
  447. Descriptor_Ptr = &HS_Int_In_Descriptor[0]; //set pointer to interface descriptor
  448. count = *Descriptor_Ptr; //read in descriptor length
  449. //写入端点1IN描述符
  450. while(count != 0)
  451. {
  452. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  453. count--;
  454. Descriptor_Ptr++;
  455. }
  456. //选择高速还是全速端点1OUT描述符
  457. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  458. Descriptor_Ptr = &Int_Out_Descriptor[0]; //set pointer to interface descriptor
  459. if(Kernel_Flag.BITS.HS_FS_State == HIGH_SPEED)
  460. Descriptor_Ptr = &HS_Int_Out_Descriptor[0]; //set pointer to interface descriptor
  461. count = *Descriptor_Ptr; //read in descriptor length
  462. //写入端点1OUT描述符
  463. while(count != 0)
  464. {
  465. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  466. count--;
  467. Descriptor_Ptr++;
  468. }
  469. //选择高速还是全速端点2IN描述符
  470. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  471. Descriptor_Ptr = &Bulk_In_Descriptor[0]; //set pointer to interface descriptor
  472. if(Kernel_Flag.BITS.HS_FS_State == HIGH_SPEED)
  473. Descriptor_Ptr = &HS_Bulk_In_Descriptor[0]; //set pointer to interface descriptor
  474. count = *Descriptor_Ptr; //read in descriptor length
  475. //写入端点2IN描述符
  476. while(count != 0)
  477. {
  478. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  479. count--;
  480. Descriptor_Ptr++;
  481. }
  482. //选择高速还是全速端点2OUT描述符
  483. if(Kernel_Flag.BITS.HS_FS_State == FULL_SPEED)
  484. Descriptor_Ptr = &Bulk_Out_Descriptor[0]; //set pointer to interface descriptor
  485. if(Kernel_Flag.BITS.HS_FS_State == HIGH_SPEED)
  486. Descriptor_Ptr = &HS_Bulk_Out_Descriptor[0]; //set pointer to interface descriptor
  487. count = *Descriptor_Ptr; //read in descriptor length
  488. //写入端点2OUT描述符
  489. while(count != 0)
  490. {
  491. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  492. count--;
  493. Descriptor_Ptr++;
  494. }
  495. }
  496. //使端点有效
  497. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.VENDP = 1; //validate FIFO
  498. wait_ep0tx();
  499. ep0out_ack();
  500. }
  501. break;
  503. case  3:  //获取字符串描述符
  504. Descriptor_Ptr = &Standard_String_ID[0]; //set pointer to interface descriptor
  505. count = *Descriptor_Ptr; //get length
  506. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  507. if(USB_Device_Request.wLength < count)
  508. count = USB_Device_Request.wLength; //get the remaining length
  509. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = count;
  510. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  511. //send string ID
  512. while(count != 0)
  513. {
  514. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr; //fill up FIFO
  515. Descriptor_Ptr++;
  516. count--;
  517. }
  518. wait_ep0tx();
  519. ep0out_ack();
  520. break;
  523. case  4:  
  524. reserved();
  525. break;
  527. case  5:  //获取端点描述符
  528. Temp = 0;
  529. if((USB_Device_Request.wValue & 0x00ff) > 0x0001)
  530. {
  531. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  532. while(!USB_Int_Flag.BITS.EP0SETUP)
  533. {
  534. //读取ISP1581中断寄存器
  535. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  536. //回写ISP1581中断寄存器
  537. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  538. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  539. return;
  540. }
  541. USB_Int_Flag.BITS.EP0TX = 0;
  542. }
  543. else
  544. {
  545. Descriptor_Ptr = &Bulk_Out_Descriptor[0]; //set pointer to Bulk Out endpoint descriptor
  546. count = *Descriptor_Ptr; //read in descriptor length
  547. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  548. if(count >= USB_Device_Request.wLength)
  549. {
  550. Temp = USB_Device_Request.wLength;
  551. //send endpoint descriptor
  552. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (UC) Temp;
  553. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = (UC) (Temp >> 8);
  554. for(count = 0 ; count < USB_Device_Request.wLength ; count++)
  555. {
  556. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  557. Descriptor_Ptr++;
  558. }
  559. wait_ep0tx();
  560. ep0out_ack();
  561. }
  562. else
  563. {
  564. USB_Device_Request.wLength -= count; //send Endpoint descriptor
  565. Temp += count;
  566. while(count != 0)
  567. {
  568. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  569. count--;
  570. Descriptor_Ptr++;
  571. }
  572. Descriptor_Ptr = &Bulk_In_Descriptor[0]; //set pointer to Bulk In endpoint descriptor
  573. count = *Descriptor_Ptr; //read in descriptor length
  574. if(count >= USB_Device_Request.wLength)
  575. {
  576. Temp += USB_Device_Request.wLength;
  577. //send endpoint descriptor
  578. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (UC) Temp;
  579. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = (UC) (Temp >> 8);
  580. for(count = 0 ; count < USB_Device_Request.wLength ; count++)
  581. {
  582. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  583. Descriptor_Ptr++;
  584. }
  585. wait_ep0tx();
  586. ep0out_ack();
  587. }
  588. else
  589. {
  590. USB_Device_Request.wLength -= count; //send Endpoint descriptor
  591. Temp += count;
  592. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (UC) Temp;
  593. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = (UC) (Temp >> 8);
  594. while(count != 0)
  595. {
  596. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  597. count--;
  598. Descriptor_Ptr++;
  599. }
  600. wait_ep0tx();
  601. ep0out_ack();
  602. }
  603. }
  604. }
  605. break;
  607. case  6:  //获取设备限制描述符
  608. Descriptor_Ptr = &HS_Device_Qualifier[0]; //set pointer to High Speed device descriptor
  609. count = *Descriptor_Ptr; //read in descriptor length
  610. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  611. if(USB_Device_Request.wLength < count)
  612. {
  613. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (UC) USB_Device_Request.wLength;
  614. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  615. count = USB_Device_Request.wLength;
  616. }
  617. else
  618. {
  619. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = count;
  620. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  621. }
  622. while(count != 0)
  623. {
  624. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr; //fill up FIFO
  625. Descriptor_Ptr++;
  626. count--;
  627. };
  628. wait_ep0tx();
  629. ep0out_ack();
  630. break;
  632. case  7  ://获取速度配置描述符
  633. Temp = 64;
  634. Descriptor_Ptr = &Other_Speed_Config_Descriptor[0]; //set pointer to configuration descriptor
  635. count = *Descriptor_Ptr; //get configuration Descriptor length
  636. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  637. if(count >= USB_Device_Request.wLength) //Send only Configuration descriptor
  638. {
  639. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (UC) USB_Device_Request.wLength;
  640. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = (UC) (USB_Device_Request.wLength >> 8);
  641. for(count = 0 ; count < USB_Device_Request.wLength ; count++)
  642. {
  643. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  644. Descriptor_Ptr++;
  645. }
  646. wait_ep0tx();
  647. ep0out_ack();
  648. }
  649. else //send Configuration,Interface and Endpoint descriptor
  650. {
  651. if(USB_Device_Request.wLength >= 32)
  652. {
  653. while(count != 0)
  654. {
  655. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  656. count--;
  657. Descriptor_Ptr++;
  658. }
  659. Descriptor_Ptr = &Bulk_Interface_Descriptor[0]; //set pointer to interface descriptor
  660. count = *Descriptor_Ptr; //get the descriptor count
  661. while(count != 0)
  662. {
  663. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  664. count--;
  665. Descriptor_Ptr++;
  666. }
  667. Descriptor_Ptr = &Int_In_Descriptor[0]; //set pointer to interface descriptor
  668. count = *Descriptor_Ptr; //read in descriptor length
  669. while(count != 0)
  670. {
  671. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  672. count--;
  673. Descriptor_Ptr++;
  674. }
  675. Descriptor_Ptr = &Int_Out_Descriptor[0]; //set pointer to interface descriptor
  676. count = *Descriptor_Ptr; //read in descriptor length
  677. while(count != 0)
  678. {
  679. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  680. count--;
  681. Descriptor_Ptr++;
  682. }
  683. Descriptor_Ptr = &Bulk_In_Descriptor[0]; //set pointer to interface descriptor
  684. count = *Descriptor_Ptr; //read in descriptor length
  685. while(count != 0)
  686. {
  687. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  688. count--;
  689. Descriptor_Ptr++;
  690. }
  691. Descriptor_Ptr = &Bulk_Out_Descriptor[0]; //set pointer to interface descriptor
  692. count = *Descriptor_Ptr; //read in descriptor length
  693. while(count != 0)
  694. {
  695. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *Descriptor_Ptr;
  696. count--;
  697. Descriptor_Ptr++;
  698. }
  699. }
  700. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.VENDP = 1; //validate FIFO
  701. wait_ep0tx();
  702. ep0out_ack();
  703. }
  704. break;
  706. case  8:  
  707. break;
  709. default  :
  710. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  711. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  712. while(!USB_Int_Flag.BITS.EP0SETUP)
  713. {
  714. //读取ISP1581中断寄存器
  715. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  716. //回写ISP1581中断寄存器
  717. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  718. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  719. return;
  720. }
  721. USB_Int_Flag.BITS.EP0TX = 0;
  722. break;
  723. }
  724. }
  726. //Set_Address设置地址
  727. void set_address(void)
  728. {
  729. USB_Int_Flag.BITS.EP0RX = 0;
  730. D14_Cntrl_Reg.D14_ADDRESS.BITS.DEVADDR = (USB_Device_Request.wValue >> 8);//设置地址
  731. //状态响应
  732. ep0in_ack();
  733. }
  735. //Set_Config设置配置
  736. void set_config(void)
  737. {
  738. USB_Int_Flag.BITS.EP0RX = 0;
  740. if(USB_Device_Request.wValue == 0)
  741. {
  742. Device_Config_Value = 0;
  743. ep0in_ack();
  744. }
  745. else if (USB_Device_Request.wValue ==  0x0100)
  746.     {
  747. //配置设备
  748. Device_Config_Value = (UC) (USB_Device_Request.wValue >> 8);
  749. // USB_Device.BITS.State = USB_Configured;
  750. ep0in_ack();
  751. }
  752. else
  753. {
  754. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  755. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  756. while(!USB_Int_Flag.BITS.EP0SETUP)
  757. {
  758. //读取ISP1581中断寄存器
  759. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  760. //回写ISP1581中断寄存器
  761. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  762. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  763. return;
  764. }
  765. USB_Int_Flag.BITS.EP0TX = 0;
  766. }
  767. }
  770. //Get_Config获取配置
  771. void get_config(void)
  772. {
  773. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  774. D14_Cntrl_Reg.D14_DATA_PORT_LSB = Device_Config_Value;
  775. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.VENDP = 1;
  776. wait_ep0tx();
  777. ep0out_ack();
  778. }
  780. //Clear_Feature特性清除
  781. void clear_feature(void)
  782. {
  783. unsigned char bRecipient = USB_Device_Request.bmRequestType & 0x0f;
  784. //端点
  785. if(bRecipient == 0x02 &&USB_Device_Request.wValue == 0x0000)
  786. {
  787. switch(USB_Device_Request.wIndex)
  788. {
  789. case  0x8000   :
  790. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  791. break;
  792. case  0x0000   :
  793. D14_Cntrl_Reg.D14_ENDPT_INDEX = 0;
  794. break;
  795. case  0x8100   :
  796. D14_Cntrl_Reg.D14_ENDPT_INDEX = 3;
  797. break;
  798. case  0x0100   :
  799. D14_Cntrl_Reg.D14_ENDPT_INDEX = 2;
  800. break;
  801. case  0x8200   :
  802. D14_Cntrl_Reg.D14_ENDPT_INDEX = 5;
  803. break;
  804. case  0x0200   :
  805. D14_Cntrl_Reg.D14_ENDPT_INDEX = 4;
  806. break;
  807. case  0x8300   :
  808. D14_Cntrl_Reg.D14_ENDPT_INDEX = 7;
  809. break;
  810. case  0x0300   :
  811. D14_Cntrl_Reg.D14_ENDPT_INDEX = 6;
  812. break;
  813. case  0x8400   :
  814. D14_Cntrl_Reg.D14_ENDPT_INDEX = 9;
  815. break;
  816. case  0x0400   :
  817. D14_Cntrl_Reg.D14_ENDPT_INDEX = 8;
  818. break;
  819. case  0x8500   :
  820. D14_Cntrl_Reg.D14_ENDPT_INDEX = 11;
  821. break;
  822. case  0x0500   :
  823. D14_Cntrl_Reg.D14_ENDPT_INDEX = 10;
  824. break;
  825. case  0x8600   :
  826. D14_Cntrl_Reg.D14_ENDPT_INDEX = 13;
  827. break;
  828. case  0x0600   :
  829. D14_Cntrl_Reg.D14_ENDPT_INDEX = 12;
  830. break;
  831. case  0x8700   :
  832. D14_Cntrl_Reg.D14_ENDPT_INDEX = 15;
  833. break;
  834. case  0x0700   :
  835. D14_Cntrl_Reg.D14_ENDPT_INDEX = 14;
  836. break;
  837. default        :  
  838. break;
  839. }                                                                                                      
  840. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 0;
  841. Kernel_Flag.BITS.Endpt_Stall = 0;
  842. D14_Cntrl_Reg.D14_ENDPT_TYPE.BITS.ENABLE = OFF; //disable FIFO
  843. D14_Cntrl_Reg.D14_ENDPT_TYPE.BITS.ENABLE = ON; //disable FIFO
  844. ep0in_ack();
  845. USB_Device.BITS.Halt = 0;
  846. }   
  847. else if(bRecipient == 0x00 && USB_Device_Request.wValue == 0x0100)
  848. { //远程唤醒
  849. USB_Device.BITS.Remote_Wakeup = 0;
  850. ep0in_ack();
  851. }
  852. else
  853. {
  854. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  855. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  856. while(!USB_Int_Flag.BITS.EP0SETUP)
  857. {
  858. //读取ISP1581中断寄存器
  859. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  860. //回写ISP1581中断寄存器
  861. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  862. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  863. return;
  864. }
  865. USB_Int_Flag.BITS.EP0TX = 0;
  866. }
  867. }
  869. //Get_Status获取设备状态
  870. void get_status(void)
  871. {
  872. if(USB_Device_Request.bmRequestType == 0x80)
  873. {
  874. //端点0IN返回0x01,0x00两字节
  875. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  876. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = 2;
  877. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  878. D14_Cntrl_Reg.D14_DATA_PORT_LSB = 1;
  879. D14_Cntrl_Reg.D14_DATA_PORT_MSB = 0;
  880. //等待发送完毕
  881. wait_ep0tx();
  882. ep0out_ack();
  883. }
  885. if(USB_Device_Request.bmRequestType == 0x81)
  886. {
  887. //端点0IN返回0x00,0x00两字节
  888. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  889. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = 2;
  890. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  891. D14_Cntrl_Reg.D14_DATA_PORT_LSB = 0;
  892. D14_Cntrl_Reg.D14_DATA_PORT_MSB = 0;
  893. wait_ep0tx();
  894. ep0out_ack();
  895. }
  897. if(USB_Device_Request.bmRequestType == 0x82)
  898. {
  899. Temp = 0;
  900. Temp = USB_Device.BITS.Halt;
  901. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  902. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = 2;
  903. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  904. D14_Cntrl_Reg.D14_DATA_PORT_LSB = (UC) Temp;
  905. D14_Cntrl_Reg.D14_DATA_PORT_MSB = (UC) (Temp >> 8);
  906. wait_ep0tx();
  907. ep0out_ack();
  908. }
  909. }
  913. //Set_Feature特性设置
  914. //不支持测试模式
  915. void set_feature(void)
  916. {
  917. unsigned char bRecipient = USB_Device_Request.bmRequestType & 0x0f;
  918. //端点
  919. if(bRecipient == 0x02 && USB_Device_Request.wValue == 0x0000)
  920. {
  921. switch(USB_Device_Request.wIndex)
  922. {
  923. case  0x8000   :
  924. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  925. break;
  926. case  0x0000   :
  927. D14_Cntrl_Reg.D14_ENDPT_INDEX = 0;
  928. break;
  929. case  0x8100   :
  930. D14_Cntrl_Reg.D14_ENDPT_INDEX = 3;
  931. break;
  932. case  0x0100   :
  933. D14_Cntrl_Reg.D14_ENDPT_INDEX = 2;
  934. break;
  935. case  0x8200   :
  936. D14_Cntrl_Reg.D14_ENDPT_INDEX = 5;
  937. break;
  938. case  0x0200   :
  939. D14_Cntrl_Reg.D14_ENDPT_INDEX = 4;
  940. break;
  941. case  0x8300   :
  942. D14_Cntrl_Reg.D14_ENDPT_INDEX = 7;
  943. break;
  944. case  0x0300   :
  945. D14_Cntrl_Reg.D14_ENDPT_INDEX = 6;
  946. break;
  947. case  0x8400   :
  948. D14_Cntrl_Reg.D14_ENDPT_INDEX = 9;
  949. break;
  950. case  0x0400   :
  951. D14_Cntrl_Reg.D14_ENDPT_INDEX = 8;
  952. break;
  953. case  0x8500   :
  954. D14_Cntrl_Reg.D14_ENDPT_INDEX = 11;
  955. break;
  956. case  0x0500   :
  957. D14_Cntrl_Reg.D14_ENDPT_INDEX = 10;
  958. break;
  959. case  0x8600   :
  960. D14_Cntrl_Reg.D14_ENDPT_INDEX = 13;
  961. break;
  962. case  0x0600   :
  963. D14_Cntrl_Reg.D14_ENDPT_INDEX = 12;
  964. break;
  965. case  0x8700   :
  966. D14_Cntrl_Reg.D14_ENDPT_INDEX = 15;
  967. break;
  968. case  0x0700   :
  969. D14_Cntrl_Reg.D14_ENDPT_INDEX = 14;
  970. break;
  971. default        :  
  972. break;
  973. }                                                                                                      
  974. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  975. Kernel_Flag.BITS.Endpt_Stall = 1;
  976. D14_Cntrl_Reg.D14_ENDPT_TYPE.BITS.ENABLE = OFF; //disable FIFO
  977. //D14_Cntrl_Reg.D14_ENDPT_TYPE.BITS.ENABLE = ON; //disable FIFO
  978. ep0in_ack();
  979. USB_Device.BITS.Halt = 0;
  980. }   
  981. else if(bRecipient == 0x00 && USB_Device_Request.wValue == 0x0100)
  982. { //远程唤醒
  983. USB_Device.BITS.Remote_Wakeup = 1;
  984. ep0in_ack();
  985. }
  986. else
  987. {
  988. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  989. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  990. while(!USB_Int_Flag.BITS.EP0SETUP)
  991. {
  992. //读取ISP1581中断寄存器
  993. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  994. //回写ISP1581中断寄存器
  995. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  996. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  997. return;
  998. }
  999. USB_Int_Flag.BITS.EP0TX = 0;
  1000. }
  1001. }
  1004. //Get_Interface 获取接口状态
  1005. void get_interface(void)
  1006. {
  1007. if(USB_Device_Request.wValue != 0)
  1008. {
  1009. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STALL = 1;
  1010. while(!USB_Int_Flag.BITS.EP0SETUP)
  1011. {
  1012. //读取ISP1581中断寄存器
  1013. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  1014. //回写ISP1581中断寄存器
  1015. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  1016. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  1017. return;
  1018. }
  1019. USB_Int_Flag.BITS.EP0TX = 0;
  1020. }
  1021. else
  1022. {
  1023. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  1024. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = 1;
  1025. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = 0;
  1026. if(!USB_Device.BITS.Alter_Interface)
  1027. D14_Cntrl_Reg.D14_DATA_PORT_LSB = 0;
  1028. else
  1029. D14_Cntrl_Reg.D14_DATA_PORT_LSB = 1;
  1030. wait_ep0tx();
  1031. ep0in_ack();
  1032. }
  1033. }
  1036. //Set_Interface 设置接口状态
  1037. void set_interface(void)
  1038. {
  1039. if(USB_Device_Request.wIndex == 0 && USB_Device_Request.wValue == 0x0100)
  1040. USB_Device.BITS.Alter_Interface = 1;
  1042. if(USB_Device_Request.wIndex == 0x0100 && USB_Device_Request.wValue == 0)
  1043. USB_Device.BITS.Alter_Interface = 0;
  1045. if(USB_Device_Request.wIndex == 0 && USB_Device_Request.wValue == 0)
  1046. USB_Device.BITS.Alter_Interface = 0;
  1048. ep0in_ack();
  1049. }
  1053. //端点0IN状态响应
  1054. void ep0in_ack(void)
  1055. {
  1056. D14_Cntrl_Reg.D14_ENDPT_INDEX = 1;
  1057. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STATUS = 1;
  1058. wait_ep0tx();
  1059. }
  1061. //端点0IN状态响应
  1062. void wait_ep0tx(void)
  1063. {
  1064. //end of status stage
  1065. while(!USB_Int_Flag.BITS.EP0TX)
  1066. {
  1067. //读取ISP1581中断寄存器
  1068. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  1069. //回写ISP1581中断寄存器
  1070. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  1071. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  1072. return;
  1073. }
  1074. USB_Int_Flag.BITS.EP0TX = 0;
  1075. }
  1077. //端点0OUT状态响应
  1078. void ep0out_ack(void)
  1079. {
  1080. //设置状态响应
  1081. //acknowledge status stage
  1082. D14_Cntrl_Reg.D14_ENDPT_INDEX = 0;
  1083. D14_Cntrl_Reg.D14_CONTROL_FUNCTION.BITS.STATUS = 1;
  1084. // D14_Cntrl_Reg.D14_CONTROL_FUNCTION.VALUE = 2;
  1085. wait_ep0rx();
  1086. }
  1088. //端点0OUT状态响应
  1089. void wait_ep0rx(void)
  1090. {
  1091. while(!USB_Int_Flag.BITS.EP0RX)
  1092. {
  1093. //读取ISP1581中断寄存器
  1094. USB_Int_Flag.VALUE |= D14_Cntrl_Reg.D14_INT.VALUE;
  1095. //回写ISP1581中断寄存器
  1096. D14_Cntrl_Reg.D14_INT.VALUE = USB_Int_Flag.VALUE;
  1097. if(USB_Int_Flag.BITS.SUSP || USB_Int_Flag.BITS.RESET)
  1098. return;
  1099. }
  1100. USB_Int_Flag.BITS.EP0RX = 0;
  1101. }
  1103. #pragma disable
  1104. unsigned int read_endpoint(unsigned char endp,unsigned int len,unsigned char *buf)
  1105. {
  1106. unsigned int datalen;
  1107. D14_Cntrl_Reg.D14_ENDPT_INDEX = endp;
  1108. len = D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB;
  1109. len <<= 8;
  1110. len += D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB;
  1111. datalen=len;
  1112. while(datalen-- != 0)
  1113. {
  1114. *buf = D14_Cntrl_Reg.D14_DATA_PORT_LSB; //fill up FIFO
  1115. buf++;
  1116. }
  1117. return len;
  1119. }
  1121. #pragma disable
  1122. unsigned int write_endpoint(unsigned char endp,unsigned int len,unsigned char *buf)
  1123. {
  1124. unsigned int datalen;
  1125. D14_Cntrl_Reg.D14_ENDPT_INDEX = endp;
  1126. D14_Cntrl_Reg.D14_BUFFER_LENGTH_LSB = (unsigned char) len;
  1127. D14_Cntrl_Reg.D14_BUFFER_LENGTH_MSB = (unsigned char) (len>>8);
  1128. datalen=len;
  1129. while(datalen-- != 0)
  1130. {
  1131. D14_Cntrl_Reg.D14_DATA_PORT_LSB = *buf; //fill up FIFO
  1132. buf++;
  1133. }
  1134. return len;
  1135. }