Changes in uspace/drv/bus/usb/usbmast/main.c [721d4b6e:d6c953e9] in mainline
- File:
-
- 1 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/bus/usb/usbmast/main.c
r721d4b6e rd6c953e9 82 82 void *arg); 83 83 84 /** Callback when a device is removed from the system.85 *86 * @param dev Representation of USB device.87 * @return Error code.88 */89 static int usbmast_device_gone(usb_device_t *dev)90 {91 usbmast_dev_t *mdev = dev->driver_data;92 assert(mdev);93 94 for (size_t i = 0; i < mdev->lun_count; ++i) {95 const int rc = ddf_fun_unbind(mdev->luns[i]);96 if (rc != EOK) {97 usb_log_error("Failed to unbind LUN function %zu: "98 "%s\n", i, str_error(rc));99 return rc;100 }101 ddf_fun_destroy(mdev->luns[i]);102 mdev->luns[i] = NULL;103 }104 free(mdev->luns);105 return EOK;106 }107 108 84 /** Callback when new device is attached and recognized as a mass storage. 109 85 * … … 111 87 * @return Error code. 112 88 */ 113 static int usbmast_ device_add(usb_device_t *dev)89 static int usbmast_add_device(usb_device_t *dev) 114 90 { 115 91 int rc; … … 118 94 119 95 /* Allocate softstate */ 120 mdev = usb_device_data_alloc(dev, sizeof(usbmast_dev_t));96 mdev = ddf_dev_data_alloc(dev->ddf_dev, sizeof(usbmast_dev_t)); 121 97 if (mdev == NULL) { 122 98 usb_log_error("Failed allocating softstate.\n"); … … 127 103 mdev->usb_dev = dev; 128 104 129 usb_log_info("Initializing mass storage `%s'.\n", dev->ddf_dev->name); 105 usb_log_info("Initializing mass storage `%s'.\n", 106 dev->ddf_dev->name); 130 107 usb_log_debug(" Bulk in endpoint: %d [%zuB].\n", 131 108 dev->pipes[BULK_IN_EP].pipe->endpoint_no, … … 136 113 137 114 usb_log_debug("Get LUN count...\n"); 138 mdev->lun_count = usb_masstor_get_lun_count(mdev); 139 mdev->luns = calloc(mdev->lun_count, sizeof(ddf_fun_t*)); 140 if (mdev->luns == NULL) { 141 rc = ENOMEM; 142 usb_log_error("Failed allocating luns table.\n"); 143 goto error; 144 } 145 146 for (i = 0; i < mdev->lun_count; i++) { 115 mdev->luns = usb_masstor_get_lun_count(mdev); 116 117 for (i = 0; i < mdev->luns; i++) { 147 118 rc = usbmast_fun_create(mdev, i); 148 119 if (rc != EOK) … … 152 123 return EOK; 153 124 error: 154 /* Destroy functions */ 155 for (size_t i = 0; i < mdev->lun_count; ++i) { 156 if (mdev->luns[i] == NULL) 157 continue; 158 const int rc = ddf_fun_unbind(mdev->luns[i]); 159 if (rc != EOK) { 160 usb_log_warning("Failed to unbind LUN function %zu: " 161 "%s.\n", i, str_error(rc)); 162 } 163 ddf_fun_destroy(mdev->luns[i]); 164 } 165 free(mdev->luns); 125 /* XXX Destroy functions */ 166 126 return rc; 167 127 } … … 203 163 } 204 164 205 mfun->ddf_fun = fun;206 165 mfun->mdev = mdev; 207 166 mfun->lun = lun; … … 254 213 255 214 free(fun_name); 256 mdev->luns[lun] = fun;257 215 258 216 return EOK; … … 337 295 /** USB mass storage driver ops. */ 338 296 static usb_driver_ops_t usbmast_driver_ops = { 339 .device_add = usbmast_device_add, 340 .device_gone = usbmast_device_gone, 297 .add_device = usbmast_add_device, 341 298 }; 342 299
Note:
See TracChangeset
for help on using the changeset viewer.