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

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

USB编程

开发平台：

C/C++

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