Changes in / [063ead6f:c20da9f] in mainline
- Location:
- uspace/drv
- Files:
-
- 9 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/pciintel/pci.c
r063ead6f rc20da9f 49 49 #include <ipc/devman.h> 50 50 #include <ipc/dev_iface.h> 51 #include <ipc/irc.h>52 #include <ipc/ns.h>53 #include <ipc/services.h>54 #include <sysinfo.h>55 51 #include <ops/hw_res.h> 56 52 #include <device/hw_res.h> … … 76 72 static bool pciintel_enable_child_interrupt(device_t *dev) 77 73 { 78 /* This is an old ugly way, copied from ne2000 driver */ 79 assert(dev); 80 pci_dev_data_t *dev_data = (pci_dev_data_t *) dev->driver_data; 81 82 sysarg_t apic; 83 sysarg_t i8259; 84 int irc_phone = -1; 85 int irc_service = 0; 86 87 if ((sysinfo_get_value("apic", &apic) == EOK) && (apic)) { 88 irc_service = SERVICE_APIC; 89 } else if ((sysinfo_get_value("i8259", &i8259) == EOK) && (i8259)) { 90 irc_service = SERVICE_I8259; 91 } 92 93 if (irc_service) { 94 while (irc_phone < 0) 95 irc_phone = service_connect_blocking(irc_service, 0, 0); 96 } else { 97 return false; 98 } 99 100 size_t i; 101 for (i = 0; i < dev_data->hw_resources.count; i++) { 102 if (dev_data->hw_resources.resources[i].type == INTERRUPT) { 103 int irq = dev_data->hw_resources.resources[i].res.interrupt.irq; 104 async_msg_1(irc_phone, IRC_ENABLE_INTERRUPT, irq); 105 } 106 } 107 108 async_hangup(irc_phone); 109 return true; 74 /* TODO */ 75 76 return false; 110 77 } 111 78 -
uspace/drv/uhci-hcd/batch.c
r063ead6f rc20da9f 141 141 usb_log_debug("Checking(%p) %d packet for completion.\n", 142 142 instance, instance->packets); 143 /* This is just an ugly trick to support the old API */ 143 144 instance->transfered_size = 0; 144 145 size_t i = 0; … … 156 157 transfer_descriptor_actual_size(&instance->tds[i]); 157 158 } 158 /* This is just an ugly trick to support the old API */159 159 instance->transfered_size -= instance->setup_size; 160 160 return true; … … 191 191 0, 1, false, instance->target, USB_PID_IN, NULL, NULL); 192 192 193 instance->tds[i].status |= TD_STATUS_COMPLETE_INTERRUPT_FLAG;194 195 193 instance->next_step = batch_call_out_and_dispose; 196 194 batch_schedule(instance); … … 223 221 transfer_descriptor_init(&instance->tds[i], DEFAULT_ERROR_COUNT, 224 222 0, 1, false, instance->target, USB_PID_OUT, NULL, NULL); 225 226 instance->tds[i].status |= TD_STATUS_COMPLETE_INTERRUPT_FLAG;227 223 228 224 instance->next_step = batch_call_in_and_dispose; … … 248 244 } 249 245 250 instance->tds[i - 1].status |= TD_STATUS_COMPLETE_INTERRUPT_FLAG;251 252 246 instance->next_step = batch_call_in_and_dispose; 253 247 batch_schedule(instance); … … 274 268 } 275 269 276 instance->tds[i - 1].status |= TD_STATUS_COMPLETE_INTERRUPT_FLAG;277 278 270 instance->next_step = batch_call_out_and_dispose; 279 271 batch_schedule(instance); -
uspace/drv/uhci-hcd/main.c
r063ead6f rc20da9f 34 34 #include <driver.h> 35 35 #include <usb_iface.h> 36 #include <usb/ddfiface.h>37 #include <device/hw_res.h>38 36 39 37 #include <errno.h> … … 48 46 #define NAME "uhci-hcd" 49 47 50 static int uhci_add_device(device_t *device); 48 static int usb_iface_get_hc_handle(device_t *dev, devman_handle_t *handle) 49 { 50 /* This shall be called only for the UHCI itself. */ 51 assert(dev->parent == NULL); 52 53 *handle = dev->handle; 54 return EOK; 55 } 51 56 52 57 static int usb_iface_get_address(device_t *dev, devman_handle_t handle, … … 70 75 } 71 76 72 73 77 static usb_iface_t hc_usb_iface = { 74 .get_hc_handle = usb_iface_get_hc_handle _hc_impl,78 .get_hc_handle = usb_iface_get_hc_handle, 75 79 .get_address = usb_iface_get_address 76 80 }; 77 /*----------------------------------------------------------------------------*/ 81 78 82 static device_ops_t uhci_ops = { 79 83 .interfaces[USB_DEV_IFACE] = &hc_usb_iface, 80 84 .interfaces[USBHC_DEV_IFACE] = &uhci_iface 81 85 }; 82 /*----------------------------------------------------------------------------*/83 static driver_ops_t uhci_driver_ops = {84 .add_device = uhci_add_device,85 };86 /*----------------------------------------------------------------------------*/87 static driver_t uhci_driver = {88 .name = NAME,89 .driver_ops = &uhci_driver_ops90 };91 /*----------------------------------------------------------------------------*/92 static void irq_handler(device_t *device, ipc_callid_t iid, ipc_call_t *call)93 {94 assert(device);95 uhci_t *hc = dev_to_uhci(device);96 uint16_t status = IPC_GET_ARG1(*call);97 assert(hc);98 uhci_interrupt(hc, status);99 }100 /*----------------------------------------------------------------------------*/101 #define CHECK_RET_RETURN(ret, message...) \102 if (ret != EOK) { \103 usb_log_error(message); \104 return ret; \105 }106 86 107 87 static int uhci_add_device(device_t *device) … … 116 96 int irq; 117 97 118 int r et =119 pci_get_my_registers(device,&io_reg_base, &io_reg_size, &irq);98 int rc = pci_get_my_registers(device, 99 &io_reg_base, &io_reg_size, &irq); 120 100 121 CHECK_RET_RETURN(ret, 122 "Failed(%d) to get I/O addresses:.\n", ret, device->handle); 101 if (rc != EOK) { 102 usb_log_error("Failed(%d) to get I/O registers addresses for device:.\n", 103 rc, device->handle); 104 return rc; 105 } 106 123 107 usb_log_info("I/O regs at 0x%X (size %zu), IRQ %d.\n", 124 108 io_reg_base, io_reg_size, irq); 125 109 126 ret = pci_enable_interrupts(device); 127 CHECK_RET_RETURN(ret, "Failed(%d) to get enable interrupts:\n", ret); 110 uhci_t *uhci_hc = malloc(sizeof(uhci_t)); 111 if (!uhci_hc) { 112 usb_log_error("Failed to allocaete memory for uhci hcd driver.\n"); 113 return ENOMEM; 114 } 128 115 129 uhci_t *uhci_hc = malloc(sizeof(uhci_t)); 130 ret = (uhci_hc != NULL) ? EOK : ENOMEM; 131 CHECK_RET_RETURN(ret, "Failed to allocate memory for uhci hcd driver.\n"); 132 133 ret = uhci_init(uhci_hc, (void*)io_reg_base, io_reg_size); 116 int ret = uhci_init(uhci_hc, (void*)io_reg_base, io_reg_size); 134 117 if (ret != EOK) { 135 118 usb_log_error("Failed to init uhci-hcd.\n"); 136 free(uhci_hc);137 119 return ret; 138 120 } 139 140 ret = register_interrupt_handler(device, irq, irq_handler,141 &uhci_hc->interrupt_code);142 if (ret != EOK) {143 usb_log_error("Failed to register interrupt handler.\n");144 uhci_fini(uhci_hc);145 free(uhci_hc);146 return ret;147 }148 149 121 device_t *rh; 150 122 ret = setup_root_hub(&rh, device); 123 151 124 if (ret != EOK) { 152 125 usb_log_error("Failed to setup uhci root hub.\n"); 153 uhci_fini(uhci_hc); 154 free(uhci_hc); 126 /* TODO: destroy uhci here */ 155 127 return ret; 156 128 } … … 159 131 if (ret != EOK) { 160 132 usb_log_error("Failed to register root hub.\n"); 161 uhci_fini(uhci_hc); 162 free(uhci_hc); 163 free(rh); 133 /* TODO: destroy uhci here */ 164 134 return ret; 165 135 } 166 136 167 137 device->driver_data = uhci_hc; 138 168 139 return EOK; 169 140 } 170 /*----------------------------------------------------------------------------*/ 141 142 static driver_ops_t uhci_driver_ops = { 143 .add_device = uhci_add_device, 144 }; 145 146 static driver_t uhci_driver = { 147 .name = NAME, 148 .driver_ops = &uhci_driver_ops 149 }; 150 171 151 int main(int argc, char *argv[]) 172 152 { 173 sleep(3); 174 usb_log_enable(USB_LOG_LEVEL_DEBUG, NAME); 153 /* 154 * Do some global initializations. 155 */ 156 sleep(5); 157 usb_log_enable(USB_LOG_LEVEL_INFO, NAME); 175 158 176 159 return driver_main(&uhci_driver); -
uspace/drv/uhci-hcd/pci.c
r063ead6f rc20da9f 121 121 return rc; 122 122 } 123 /*----------------------------------------------------------------------------*/ 124 int pci_enable_interrupts(device_t *device) 125 { 126 int parent_phone = devman_parent_device_connect(device->handle, 127 IPC_FLAG_BLOCKING); 128 bool enabled = hw_res_enable_interrupt(parent_phone); 129 return enabled ? EOK : EIO; 130 } 123 131 124 /** 132 125 * @} -
uspace/drv/uhci-hcd/pci.h
r063ead6f rc20da9f 39 39 40 40 int pci_get_my_registers(device_t *, uintptr_t *, size_t *, int *); 41 int pci_enable_interrupts(device_t *device);42 41 43 42 #endif -
uspace/drv/uhci-hcd/transfer_list.c
r063ead6f rc20da9f 111 111 /* I'm the first one here */ 112 112 if (batch->link.prev == &instance->batch_list) { 113 usb_log_debug("Removing batch%p was first, next element %x.\n",113 usb_log_debug("Removing tracer %p was first, next element %x.\n", 114 114 batch, batch->qh->next_queue); 115 115 instance->queue_head->element = batch->qh->next_queue; 116 116 } else { 117 usb_log_debug("Removing batch%p was NOT first, next element %x.\n",117 usb_log_debug("Removing tracer %p was NOT first, next element %x.\n", 118 118 batch, batch->qh->next_queue); 119 119 batch_t *prev = list_get_instance(batch->link.prev, batch_t, link); -
uspace/drv/uhci-hcd/uhci-hcd.ma
r063ead6f rc20da9f 1 1 10 pci/ven=8086&dev=7020 2 10 pci/ven=8086&dev=7112 2 -
uspace/drv/uhci-hcd/uhci.c
r063ead6f rc20da9f 39 39 40 40 #include "uhci.h" 41 static irq_cmd_t uhci_cmds[] = {42 {43 .cmd = CMD_PIO_READ_16,44 .addr = (void*)0xc022,45 .dstarg = 146 },47 {48 .cmd = CMD_PIO_WRITE_16,49 .addr = (void*)0xc022,50 .value = 0x1f51 },52 {53 .cmd = CMD_ACCEPT54 }55 };56 41 57 42 static int uhci_init_transfer_lists(uhci_t *instance); 58 static int uhci_init_mem_structures(uhci_t *instance); 59 static void uhci_init_hw(uhci_t *instance); 60 61 static int uhci_interrupt_emulator(void *arg); 43 static int uhci_clean_finished(void *arg); 62 44 static int uhci_debug_checker(void *arg); 63 64 45 static bool allowed_usb_packet( 65 46 bool low_speed, usb_transfer_type_t, size_t size); 66 47 67 #define CHECK_RET_RETURN(ret, message...) \ 48 int uhci_init(uhci_t *instance, void *regs, size_t reg_size) 49 { 50 #define CHECK_RET_RETURN(message...) \ 68 51 if (ret != EOK) { \ 69 52 usb_log_error(message); \ … … 71 54 } else (void) 0 72 55 73 int uhci_init(uhci_t *instance, void *regs, size_t reg_size) 74 { 75 assert(reg_size >= sizeof(regs_t));56 /* init address keeper(libusb) */ 57 usb_address_keeping_init(&instance->address_manager, USB11_ADDRESS_MAX); 58 usb_log_debug("Initialized address manager.\n"); 76 59 77 60 /* allow access to hc control registers */ 78 61 regs_t *io; 62 assert(reg_size >= sizeof(regs_t)); 79 63 int ret = pio_enable(regs, reg_size, (void**)&io); 80 CHECK_RET_RETURN( ret,"Failed to gain access to registers at %p.\n", io);64 CHECK_RET_RETURN("Failed to gain access to registers at %p.\n", io); 81 65 instance->registers = io; 82 66 usb_log_debug("Device registers accessible.\n"); 83 67 84 ret = uhci_init_mem_structures(instance);85 CHECK_RET_RETURN(ret, "Failed to initialize memory structures.\n");86 87 uhci_init_hw(instance);88 89 instance->cleaner = fibril_create(uhci_interrupt_emulator, instance);90 // fibril_add_ready(instance->cleaner);91 92 instance->debug_checker = fibril_create(uhci_debug_checker, instance);93 fibril_add_ready(instance->debug_checker);94 95 return EOK;96 }97 /*----------------------------------------------------------------------------*/98 void uhci_init_hw(uhci_t *instance)99 {100 101 /* set framelist pointer */102 const uint32_t pa = addr_to_phys(instance->frame_list);103 pio_write_32(&instance->registers->flbaseadd, pa);104 105 /* enable all interrupts, but resume interrupt */106 pio_write_16(&instance->registers->usbintr,107 UHCI_INTR_CRC | UHCI_INTR_COMPLETE | UHCI_INTR_SHORT_PACKET);108 109 /* Start the hc with large(64B) packet FSBR */110 pio_write_16(&instance->registers->usbcmd,111 UHCI_CMD_RUN_STOP | UHCI_CMD_MAX_PACKET | UHCI_CMD_CONFIGURE);112 usb_log_debug("Started UHCI HC.\n");113 }114 /*----------------------------------------------------------------------------*/115 int uhci_init_mem_structures(uhci_t *instance)116 {117 assert(instance);118 119 /* init interrupt code */120 irq_cmd_t *interrupt_commands = malloc(sizeof(uhci_cmds));121 if (interrupt_commands == NULL) {122 return ENOMEM;123 }124 memcpy(interrupt_commands, uhci_cmds, sizeof(uhci_cmds));125 interrupt_commands[0].addr = (void*)&instance->registers->usbsts;126 interrupt_commands[1].addr = (void*)&instance->registers->usbsts;127 instance->interrupt_code.cmds = interrupt_commands;128 instance->interrupt_code.cmdcount =129 sizeof(uhci_cmds) / sizeof(irq_cmd_t);130 131 68 /* init transfer lists */ 132 int ret = uhci_init_transfer_lists(instance); 133 CHECK_RET_RETURN(ret, "Failed to initialize transfer lists.\n"); 134 usb_log_debug("Initialized transfer lists.\n"); 135 136 /* frame list initialization */ 69 ret = uhci_init_transfer_lists(instance); 70 CHECK_RET_RETURN("Failed to initialize transfer lists.\n"); 71 usb_log_debug("Transfer lists initialized.\n"); 72 73 74 usb_log_debug("Initializing frame list.\n"); 137 75 instance->frame_list = get_page(); 138 76 ret = instance ? EOK : ENOMEM; 139 CHECK_RET_RETURN(ret, "Failed to get frame list page.\n"); 140 usb_log_debug("Initialized frame list.\n"); 77 CHECK_RET_RETURN("Failed to get frame list page.\n"); 141 78 142 79 /* initialize all frames to point to the first queue head */ … … 149 86 } 150 87 151 /* init address keeper(libusb) */ 152 usb_address_keeping_init(&instance->address_manager, USB11_ADDRESS_MAX); 153 usb_log_debug("Initialized address manager.\n"); 88 const uintptr_t pa = (uintptr_t)addr_to_phys(instance->frame_list); 89 pio_write_32(&instance->registers->flbaseadd, (uint32_t)pa); 90 91 list_initialize(&instance->batch_list); 92 fibril_mutex_initialize(&instance->batch_list_mutex); 93 94 instance->cleaner = fibril_create(uhci_clean_finished, instance); 95 fibril_add_ready(instance->cleaner); 96 97 instance->debug_checker = fibril_create(uhci_debug_checker, instance); 98 fibril_add_ready(instance->debug_checker); 99 100 /* Start the hc with large(64B) packet FSBR */ 101 pio_write_16(&instance->registers->usbcmd, 102 UHCI_CMD_RUN_STOP | UHCI_CMD_MAX_PACKET); 103 usb_log_debug("Started UHCI HC.\n"); 104 105 uint16_t cmd = pio_read_16(&instance->registers->usbcmd); 106 cmd |= UHCI_CMD_DEBUG; 107 pio_write_16(&instance->registers->usbcmd, cmd); 154 108 155 109 return EOK; … … 160 114 assert(instance); 161 115 162 /* initialize TODO: check errors*/116 /* initialize */ 163 117 int ret; 164 118 ret = transfer_list_init(&instance->transfers_bulk_full, "BULK_FULL"); … … 192 146 instance->transfers[1][USB_TRANSFER_CONTROL] = 193 147 &instance->transfers_control_slow; 194 instance->transfers[0][USB_TRANSFER_ BULK] =195 &instance->transfers_ bulk_full;148 instance->transfers[0][USB_TRANSFER_CONTROL] = 149 &instance->transfers_control_full; 196 150 197 151 return EOK; … … 220 174 } 221 175 /*----------------------------------------------------------------------------*/ 222 void uhci_interrupt(uhci_t *instance, uint16_t status) 223 { 224 assert(instance); 225 if ((status & (UHCI_STATUS_INTERRUPT | UHCI_STATUS_ERROR_INTERRUPT)) == 0) 226 return; 227 usb_log_debug("UHCI interrupt: %X.\n", status); 228 transfer_list_check(&instance->transfers_interrupt); 229 transfer_list_check(&instance->transfers_control_slow); 230 transfer_list_check(&instance->transfers_control_full); 231 transfer_list_check(&instance->transfers_bulk_full); 232 } 233 /*----------------------------------------------------------------------------*/ 234 int uhci_interrupt_emulator(void* arg) 235 { 236 usb_log_debug("Started interrupt emulator.\n"); 176 int uhci_clean_finished(void* arg) 177 { 178 usb_log_debug("Started cleaning fibril.\n"); 237 179 uhci_t *instance = (uhci_t*)arg; 238 180 assert(instance); 239 181 240 182 while(1) { 241 uint16_t status = pio_read_16(&instance->registers->usbsts); 242 uhci_interrupt(instance, status); 183 transfer_list_check(&instance->transfers_interrupt); 184 transfer_list_check(&instance->transfers_control_slow); 185 transfer_list_check(&instance->transfers_control_full); 186 transfer_list_check(&instance->transfers_bulk_full); 243 187 async_usleep(UHCI_CLEANER_TIMEOUT); 244 188 } … … 251 195 assert(instance); 252 196 while (1) { 253 const uint16_t cmd = pio_read_16(&instance->registers->usbcmd); 254 const uint16_t sts = pio_read_16(&instance->registers->usbsts); 255 const uint16_t intr = pio_read_16(&instance->registers->usbintr); 256 usb_log_debug("Command: %X Status: %X Interrupts: %x\n", 257 cmd, sts, intr); 197 uint16_t cmd = pio_read_16(&instance->registers->usbcmd); 198 uint16_t sts = pio_read_16(&instance->registers->usbsts); 199 usb_log_debug("Command register: %X Status register: %X\n", cmd, sts); 258 200 259 201 uintptr_t frame_list = pio_read_32(&instance->registers->flbaseadd); 260 if (frame_list != addr_to_phys(instance->frame_list)) {202 if (frame_list != (uintptr_t)addr_to_phys(instance->frame_list)) { 261 203 usb_log_debug("Framelist address: %p vs. %p.\n", 262 204 frame_list, addr_to_phys(instance->frame_list)); -
uspace/drv/uhci-hcd/uhci.h
r063ead6f rc20da9f 66 66 67 67 uint16_t usbintr; 68 #define UHCI_INTR_SHORT_PACKET (1 << 3)69 #define UHCI_INTR_COMPLETE (1 << 2)70 #define UHCI_INTR_RESUME (1 << 1)71 #define UHCI_INTR_CRC (1 << 0)72 73 68 uint16_t frnum; 74 69 uint32_t flbaseadd; … … 86 81 link_pointer_t *frame_list; 87 82 83 link_t batch_list; 84 fibril_mutex_t batch_list_mutex; 85 88 86 transfer_list_t transfers_bulk_full; 89 87 transfer_list_t transfers_control_full; … … 92 90 93 91 transfer_list_t *transfers[2][4]; 94 95 irq_code_t interrupt_code;96 92 97 93 fid_t cleaner; … … 102 98 int uhci_init(uhci_t *instance, void *regs, size_t reg_size); 103 99 104 static inline void uhci_fini(uhci_t *instance) {}; 100 int uhci_fini(uhci_t *device); 101 102 int uhci_transfer( 103 uhci_t *instance, 104 device_t *dev, 105 usb_target_t target, 106 usb_transfer_type_t transfer_type, 107 bool toggle, 108 usb_packet_id pid, 109 bool low_speed, 110 void *buffer, size_t size, 111 usbhc_iface_transfer_out_callback_t callback_out, 112 usbhc_iface_transfer_in_callback_t callback_in, 113 void *arg ); 105 114 106 115 int uhci_schedule(uhci_t *instance, batch_t *batch); 107 116 108 void uhci_interrupt(uhci_t *instance, uint16_t status);109 110 117 static inline uhci_t * dev_to_uhci(device_t *dev) 111 118 { return (uhci_t*)dev->driver_data; } 112 113 119 114 120 #endif
Note:
See TracChangeset
for help on using the changeset viewer.