| 0,0 → 1,154 |
|---|
| |
| struct hid_class_descriptor { |
| u8_t bDescriptorType; |
| u16_t wDescriptorLength; |
| } __attribute__ ((packed)); |
| |
| struct hid_descriptor { |
| u8_t bLength; |
| u8_t bDescriptorType; |
| u16_t bcdHID; |
| u8_t bCountryCode; |
| u8_t bNumDescriptors; |
| |
| struct hid_class_descriptor desc[1]; |
| } __attribute__ ((packed)); |
| |
| void create_hid_mouse(udev_t *dev, endpoint_descr_t *en_d); |
| |
| Bool init_hid(udev_t *dev) |
| { |
| interface_descr_t *interface; |
| struct hid_descriptor *hds; |
| struct hid_class_descriptor *hidclass; |
| u8_t *dptr = (u8_t*)dev->conf; |
| |
| int i=0, j=0; |
| |
| dbgprintf( "init hid device\n"); |
| |
| dptr+= dev->conf->bLength; |
| |
| // for(i = 0; i < dev->conf->bNumInterfaces; i++) |
| // { |
| interface = (interface_descr_t*)dptr; |
| dptr+= interface->bLength; |
| |
| dbgprintf("interface %d\n\n" |
| "bLength %d\n" |
| "bDescriptorType %d\n" |
| "bInterfaceNumber %d\n" |
| "bAlternateSetting %d\n" |
| "bNumEndpoints %d\n" |
| "bInterfaceClass %d\n" |
| "bInterfaceSubClass %d\n" |
| "bInterfaceProtocol %d\n" |
| "iInterface %d\n\n", |
| i+1, |
| interface->bLength, |
| interface->bDescriptorType, |
| interface->bInterfaceNumber, |
| interface->bAlternateSetting, |
| interface->bNumEndpoints, |
| interface->bInterfaceClass, |
| interface->bInterfaceSubClass, |
| interface->bInterfaceProtocol, |
| interface->iInterface); |
| |
| hds = (struct hid_descriptor*) dptr; |
| |
| dbgprintf("hid descriptor\n\n" |
| "bLength %d\n" |
| "bDescriptorType %d\n" |
| "bcdHID %x\n" |
| "bCountryCode %d\n" |
| "bNumDescriptors %d\n", |
| hds->bLength, |
| hds->bDescriptorType, |
| hds->bcdHID, |
| hds->bCountryCode, |
| hds->bNumDescriptors); |
| |
| for(j=0; j < hds->bNumDescriptors; j++) |
| { |
| dbgprintf("bDescriptorType %d\n" |
| "wDescriptorLength %d\n", |
| hds->desc[j].bDescriptorType, |
| hds->desc[j].wDescriptorLength); |
| }; |
| dptr+= hds->bLength; |
| |
| endpoint_descr_t *ep; |
| ep = (endpoint_descr_t*)dptr; |
| |
| dbgprintf("\nendpoint\n\n" |
| "bLength %d\n" |
| "bDescriptorType %d\n" |
| "bEndpointAddress %d\n" |
| "bmAttributes %d\n" |
| "wMaxPacketSize %d\n" |
| "bInterval %d\n", |
| ep->bLength, ep->bDescriptorType, |
| ep->bEndpointAddress, ep->bmAttributes, |
| ep->wMaxPacketSize, ep->bInterval); |
| dptr+= ep->bLength; |
| |
| if( interface->bInterfaceProtocol == 2) |
| create_hid_mouse(dev, ep); |
| // } |
| return TRUE; |
| }; |
| |
| |
| Bool mouse_handler(udev_t *dev, struct tag_request *rq) |
| { |
| td_t *td; |
| |
| td = rq->td_head; |
| |
| if( (td->status &0x7FF)==rq->size-1) |
| { |
| struct boot_packet *pkt; |
| pkt = (struct boot_packet *)rq->data; |
| SetMouseData(pkt->buttons, pkt->x, -pkt->y, -pkt->z, 0); |
| }; |
| td->status = 0x00800000 | dev->speed; |
| td->token ^= DATA1; |
| |
| return TRUE; |
| }; |
| |
| void create_hid_mouse(udev_t *dev, endpoint_descr_t *en_d) |
| { |
| request_t *rq; |
| endp_t enp; |
| |
| addr_t address; |
| addr_t size; |
| u32_t toggle; |
| |
| void *packet; |
| |
| td_t *td; |
| qh_t *qh; |
| |
| static u16_t __attribute__((aligned(16))) |
| req_set_conf[4] = {0x0900,0x0001,0x0000,0x0000}; |
| |
| if( !ctrl_request(dev, req_set_conf, DOUT, 0, 0)) |
| return; |
| |
| enp.address = en_d->bEndpointAddress; |
| enp.size = en_d->wMaxPacketSize; |
| enp.toggle = DATA0; |
| |
| packet = malloc(enp.size); |
| memset(packet, 0, enp.size); |
| |
| rq = create_request(dev, &enp, DIN, packet, enp.size); |
| rq->handler = &mouse_handler; |
| |
| list_prepend(&rq->link, &rq_list); |
| |
| dbgprintf("create_hid_mouse\n"); |
| } |