Changes in uspace/drv/bus/usb/uhcirh/port.c [e882e3a:c53007f] in mainline
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/bus/usb/uhcirh/port.c
re882e3a rc53007f 32 32 * @brief UHCI root hub port routines 33 33 */ 34 #include < libarch/ddi.h> /* pio_read and pio_write */34 #include <ddi.h> 35 35 #include <fibril_synch.h> /* async_usleep */ 36 36 #include <errno.h> … … 63 63 return pio_read_16(port->address); 64 64 } 65 /*----------------------------------------------------------------------------*/ 65 66 66 /** Register writing helper function. 67 67 * … … 75 75 pio_write_16(port->address, val); 76 76 } 77 /*----------------------------------------------------------------------------*/ 77 78 78 /** Initialize UHCI root hub port instance. 79 79 * … … 127 127 return EOK; 128 128 } 129 /*----------------------------------------------------------------------------*/ 129 130 130 /** Cleanup UHCI root hub port instance. 131 131 * … … 141 141 return; 142 142 } 143 /*----------------------------------------------------------------------------*/ 143 144 144 /** Periodically checks port status and reports new devices. 145 145 * … … 150 150 { 151 151 uhci_port_t *instance = port; 152 int rc; 152 153 assert(instance); 153 154 154 155 unsigned allowed_failures = MAX_ERROR_COUNT; 155 #define CHECK_RET_FAIL(ret, msg...) \156 if (ret != EOK) { \157 usb_log_error(msg); \158 if (!(allowed_failures-- > 0)) { \159 usb_log_fatal( \160 "Maximum number of failures reached, " \161 "bailing out.\n"); \162 return ret; \163 } \164 continue; \165 } else (void)0166 156 167 157 while (1) { … … 182 172 instance->id_string, port_status); 183 173 184 int ret = usb_hc_connection_open(&instance->hc_connection); 185 CHECK_RET_FAIL(ret, "%s: Failed to connect to HC %s.\n", 186 instance->id_string, str_error(ret)); 174 rc = usb_hc_connection_open(&instance->hc_connection); 175 if (rc != EOK) { 176 usb_log_error("%s: Failed to connect to HC %s.\n", 177 instance->id_string, str_error(rc)); 178 if (!(allowed_failures-- > 0)) 179 goto fatal_error; 180 continue; 181 } 187 182 188 183 /* Remove any old device */ … … 204 199 } 205 200 206 ret = usb_hc_connection_close(&instance->hc_connection); 207 CHECK_RET_FAIL(ret, "%s: Failed to disconnect from hc: %s.\n", 208 instance->id_string, str_error(ret)); 209 } 210 return EOK; 211 } 212 /*----------------------------------------------------------------------------*/ 201 rc = usb_hc_connection_close(&instance->hc_connection); 202 if (rc != EOK) { 203 usb_log_error("%s: Failed to disconnect from HC %s.\n", 204 instance->id_string, str_error(rc)); 205 if (!(allowed_failures-- > 0)) 206 goto fatal_error; 207 continue; 208 } 209 } 210 211 return EOK; 212 213 fatal_error: 214 usb_log_fatal("Maximum number of failures reached, bailing out.\n"); 215 return rc; 216 } 217 213 218 /** Callback for enabling port during adding a new device. 214 219 * … … 247 252 return EOK; 248 253 } 249 /*----------------------------------------------------------------------------*/ 254 250 255 /** Initialize and report connected device. 251 256 * … … 279 284 usb_log_info("%s: New device, address %d (handle %" PRIun ").\n", 280 285 port->id_string, port->attached_device.address, 281 port->attached_device.fun->handle);282 return EOK; 283 } 284 /*----------------------------------------------------------------------------*/ 286 ddf_fun_get_handle(port->attached_device.fun)); 287 return EOK; 288 } 289 285 290 /** Remove device. 286 291 * … … 324 329 return EOK; 325 330 } 326 /*----------------------------------------------------------------------------*/ 331 327 332 /** Enable or disable root hub port. 328 333 * … … 358 363 return EOK; 359 364 } 360 /*----------------------------------------------------------------------------*/ 365 361 366 /** Print the port status value in a human friendly way 362 367 *
Note:
See TracChangeset
for help on using the changeset viewer.