#if defined(lint) && !defined(DEBUG)
#define DEBUG
#endif
#define USBDRV_MAJOR_VER 2
#define USBDRV_MINOR_VER 0
#include <sys/usb/usba.h>
#include <sys/strsun.h>
#include <sys/usb/clients/usbskel/usbskel.h>
int usbskel_errlevel = USBSKEL_LOG_LOG;
static char *name = "usbskl";
static boolean_t usbskel_dumptree;
static int usbskel_attach(dev_info_t *, ddi_attach_cmd_t);
static int usbskel_detach(dev_info_t *, ddi_detach_cmd_t);
static int usbskel_info(dev_info_t *, ddi_info_cmd_t, void *, void **);
static int usbskel_cleanup(dev_info_t *, usbskel_state_t *);
static int usbskel_open(dev_t *, int, int, cred_t *);
static int usbskel_close(dev_t, int, int, cred_t *);
static int usbskel_read(dev_t, struct uio *uip_p, cred_t *);
static int usbskel_strategy(struct buf *);
static void usbskel_minphys(struct buf *);
static void usbskel_normal_callback(usb_pipe_handle_t, usb_ctrl_req_t *);
static void usbskel_exception_callback(usb_pipe_handle_t, usb_ctrl_req_t *);
static int usbskel_ioctl(dev_t, int, intptr_t, int, cred_t *, int *);
static int usbskel_disconnect_callback(dev_info_t *);
static int usbskel_reconnect_callback(dev_info_t *);
static void usbskel_restore_device_state(dev_info_t *, usbskel_state_t *);
static int usbskel_cpr_suspend(dev_info_t *);
static void usbskel_cpr_resume(dev_info_t *);
static int usbskel_test_and_adjust_device_state(usbskel_state_t *);
static int usbskel_open_pipes(usbskel_state_t *);
static void usbskel_close_pipes(usbskel_state_t *);
static int usbskel_pm_busy_component(usbskel_state_t *);
static void usbskel_pm_idle_component(usbskel_state_t *);
static int usbskel_power(dev_info_t *, int, int);
#ifdef USBSKEL_PM
static int usbskel_init_power_mgmt(usbskel_state_t *);
static void usbskel_destroy_power_mgmt(usbskel_state_t *);
#endif
static int usbskel_serialize_access(usbskel_state_t *, boolean_t);
static void usbskel_release_access(usbskel_state_t *);
static int usbskel_check_same_device(usbskel_state_t *);
static void usbskel_log(usbskel_state_t *, int, char *, ...);
_NOTE(SCHEME_PROTECTS_DATA("unique per call", usb_ctrl_req))
_NOTE(SCHEME_PROTECTS_DATA("unique per call", buf))
struct cb_ops usbskel_cb_ops = {
usbskel_open,
usbskel_close,
usbskel_strategy,
nulldev,
nulldev,
usbskel_read,
nodev,
usbskel_ioctl,
nulldev,
nodev,
nodev,
nochpoll,
ddi_prop_op,
NULL,
D_MP
};
static struct dev_ops usbskel_ops = {
DEVO_REV,
0,
usbskel_info,
nulldev,
nulldev,
usbskel_attach,
usbskel_detach,
nodev,
&usbskel_cb_ops,
NULL,
usbskel_power,
ddi_quiesce_not_needed,
};
static struct modldrv usbskel_modldrv = {
&mod_driverops,
"USB skeleton driver",
&usbskel_ops
};
static struct modlinkage modlinkage = {
MODREV_1,
&usbskel_modldrv,
NULL
};
#define USBSKEL_INITIAL_SOFT_SPACE 1
static void *usbskel_statep;
int
_init(void)
{
int rval;
usbskel_log(NULL, USBSKEL_LOG_LOG, "usbskel _init");
if ((rval = ddi_soft_state_init(&usbskel_statep,
sizeof (usbskel_state_t), USBSKEL_INITIAL_SOFT_SPACE)) != 0) {
return (rval);
}
if ((rval = mod_install(&modlinkage)) != 0) {
ddi_soft_state_fini(&usbskel_statep);
}
usbskel_log(NULL, USBSKEL_LOG_LOG, "usbskel _init done");
return (rval);
}
int
_fini(void)
{
int rval;
usbskel_log(NULL, USBSKEL_LOG_LOG, "usbskel _fini");
if ((rval = mod_remove(&modlinkage)) != 0) {
return (rval);
}
ddi_soft_state_fini(&usbskel_statep);
usbskel_log(NULL, USBSKEL_LOG_LOG, "usbskel _fini done");
return (rval);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
static int
usbskel_info(dev_info_t *dip, ddi_info_cmd_t infocmd,
void *arg, void **result)
{
usbskel_state_t *usbskelp;
int error = DDI_FAILURE;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
if ((usbskelp = ddi_get_soft_state(usbskel_statep,
getminor((dev_t)arg))) != NULL) {
*result = usbskelp->usbskel_dip;
if (*result != NULL) {
error = DDI_SUCCESS;
}
} else {
*result = NULL;
}
break;
case DDI_INFO_DEVT2INSTANCE:
*result = (void *)(uintptr_t)getminor((dev_t)arg);
error = DDI_SUCCESS;
break;
default:
break;
}
return (error);
}
static int
usbskel_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int instance = ddi_get_instance(dip);
char *devinst;
int devinstlen;
usbskel_state_t *usbskelp = NULL;
usb_reg_parse_lvl_t parse_level;
usb_ep_data_t *ep_datap;
int status;
switch (cmd) {
case DDI_ATTACH:
break;
case DDI_RESUME:
usbskel_cpr_resume(dip);
return (DDI_SUCCESS);
default:
return (DDI_FAILURE);
}
if (ddi_soft_state_zalloc(usbskel_statep, instance) == DDI_SUCCESS) {
usbskelp = ddi_get_soft_state(usbskel_statep, instance);
}
if (usbskelp == NULL) {
return (DDI_FAILURE);
}
usbskelp->usbskel_dip = dip;
devinst = kmem_zalloc(USB_MAXSTRINGLEN, KM_SLEEP);
devinstlen = snprintf(devinst, USB_MAXSTRINGLEN, "%s%d: ",
ddi_driver_name(dip), instance);
usbskelp->usbskel_devinst = kmem_zalloc(devinstlen + 1, KM_SLEEP);
(void) strncpy(usbskelp->usbskel_devinst, devinst, devinstlen);
kmem_free(devinst, USB_MAXSTRINGLEN);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "Attach: enter for attach");
usbskel_dumptree = (ddi_prop_exists(DDI_DEV_T_ANY, dip,
DDI_PROP_DONTPASS, "usbskel_dumptree") == 1);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "Tree will %sbe dumped",
((usbskel_dumptree) ? "" : "not "));
parse_level = (usb_reg_parse_lvl_t)ddi_prop_get_int(
DDI_DEV_T_ANY, dip, DDI_PROP_DONTPASS,
"usbskel_parse_level", USB_PARSE_LVL_ALL);
switch (parse_level) {
case USB_PARSE_LVL_NONE:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"parse_level requested to NOT DUMP");
parse_level = USB_PARSE_LVL_IF;
case USB_PARSE_LVL_IF:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"parse_level set to dump specific interface");
break;
case USB_PARSE_LVL_CFG:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"parse_level set to dump specific config");
break;
case USB_PARSE_LVL_ALL:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"parse_level set to dump everything");
break;
default:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"attach: parse_level will default to dump everything");
parse_level = USB_PARSE_LVL_ALL;
}
if ((status = usb_client_attach(dip, USBDRV_VERSION, 0)) !=
USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"attach: usb_client_attach failed, error code:%d", status);
goto fail;
}
if ((status = usb_get_dev_data(dip, &usbskelp->usbskel_reg, parse_level,
0)) != USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"attach: usb_get_dev_data failed, error code:%d", status);
goto fail;
}
if (usbskel_dumptree) {
(void) usb_print_descr_tree(
usbskelp->usbskel_dip, usbskelp->usbskel_reg);
}
if ((ep_datap = usb_lookup_ep_data(dip, usbskelp->usbskel_reg,
usbskelp->usbskel_reg->dev_curr_if, 0, 0,
USB_EP_ATTR_INTR, USB_EP_DIR_IN)) == NULL) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"attach: Error getting intr endpoint descriptor");
goto fail;
}
usbskelp->usbskel_intr_ep_descr = ep_datap->ep_descr;
usb_free_descr_tree(dip, usbskelp->usbskel_reg);
mutex_init(&usbskelp->usbskel_mutex, NULL, MUTEX_DRIVER,
usbskelp->usbskel_reg->dev_iblock_cookie);
cv_init(&usbskelp->usbskel_serial_cv, NULL, CV_DRIVER, NULL);
usbskelp->usbskel_serial_inuse = B_FALSE;
usbskelp->usbskel_locks_initialized = B_TRUE;
if (ddi_create_minor_node(dip, name, S_IFCHR, instance,
"usb_skeleton", 0) != DDI_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"attach: Error creating minor node");
goto fail;
}
usbskelp->usbskel_dev_state = USB_DEV_ONLINE;
#ifdef USBSKEL_PM
if (usbskel_init_power_mgmt(usbskelp) != USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"attach: Could not initialize power mgmt");
}
#endif
if (usb_register_hotplug_cbs(dip, usbskel_disconnect_callback,
usbskel_reconnect_callback) != USB_SUCCESS) {
goto fail;
}
ddi_report_dev(dip);
return (DDI_SUCCESS);
fail:
if (usbskelp) {
(void) usbskel_cleanup(dip, usbskelp);
}
return (DDI_FAILURE);
}
static int
usbskel_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
int instance = ddi_get_instance(dip);
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, instance);
int rval = DDI_FAILURE;
switch (cmd) {
case DDI_DETACH:
mutex_enter(&usbskelp->usbskel_mutex);
ASSERT((usbskelp->usbskel_drv_state & USBSKEL_OPEN) == 0);
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"Detach: enter for detach");
rval = usbskel_cleanup(dip, usbskelp);
break;
case DDI_SUSPEND:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"Detach: enter for suspend");
rval = usbskel_cpr_suspend(dip);
default:
break;
}
return ((rval == USB_SUCCESS) ? DDI_SUCCESS : DDI_FAILURE);
}
static int
usbskel_cleanup(dev_info_t *dip, usbskel_state_t *usbskelp)
{
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "Cleanup: enter");
if (usbskelp->usbskel_locks_initialized) {
usb_unregister_hotplug_cbs(dip);
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
#ifdef USBSKEL_PM
usbskel_destroy_power_mgmt(usbskelp);
#endif
ddi_remove_minor_node(dip, NULL);
cv_destroy(&usbskelp->usbskel_serial_cv);
mutex_destroy(&usbskelp->usbskel_mutex);
}
usb_client_detach(dip, usbskelp->usbskel_reg);
if (usbskelp->usbskel_devinst != NULL) {
kmem_free(usbskelp->usbskel_devinst,
strlen(usbskelp->usbskel_devinst) + 1);
}
ddi_soft_state_free(usbskel_statep, ddi_get_instance(dip));
ddi_prop_remove_all(dip);
return (USB_SUCCESS);
}
static int
usbskel_open(dev_t *devp, int flag, int otyp, cred_t *cred_p)
{
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, getminor(*devp));
int rval = 0;
if (usbskelp == NULL) {
return (ENXIO);
}
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "open: enter");
mutex_enter(&usbskelp->usbskel_mutex);
if ((usbskelp->usbskel_drv_state & USBSKEL_OPEN) != 0) {
mutex_exit(&usbskelp->usbskel_mutex);
return (EBUSY);
}
usbskelp->usbskel_drv_state |= USBSKEL_OPEN;
if (usbskel_serialize_access(usbskelp, USBSKEL_SER_SIG) == 0) {
usbskelp->usbskel_drv_state &= ~USBSKEL_OPEN;
mutex_exit(&usbskelp->usbskel_mutex);
return (EINTR);
}
mutex_exit(&usbskelp->usbskel_mutex);
if (usbskel_pm_busy_component(usbskelp) != DDI_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"open: Error raising power");
rval = EIO;
goto done;
}
mutex_enter(&usbskelp->usbskel_mutex);
if (usbskelp->usbskel_dev_state != USB_DEV_ONLINE) {
mutex_exit(&usbskelp->usbskel_mutex);
rval = EIO;
goto done;
}
mutex_exit(&usbskelp->usbskel_mutex);
if (usbskel_open_pipes(usbskelp) != USB_SUCCESS) {
rval = EIO;
goto done;
}
done:
if (rval != 0) {
mutex_enter(&usbskelp->usbskel_mutex);
usbskelp->usbskel_drv_state &= ~USBSKEL_OPEN;
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_pm_idle_component(usbskelp);
} else {
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
}
return (rval);
}
static int
usbskel_close(dev_t dev, int flag, int otyp, cred_t *cred_p)
{
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, getminor(dev));
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "close: enter");
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "close: cleaning up...");
(void) usb_pipe_drain_reqs(usbskelp->usbskel_dip,
usbskelp->usbskel_reg->dev_default_ph, 0,
USB_FLAGS_SLEEP, NULL, 0);
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_close_pipes(usbskelp);
usbskelp->usbskel_drv_state &= ~USBSKEL_OPEN;
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_pm_idle_component(usbskelp);
return (0);
}
static int
usbskel_read(dev_t dev, struct uio *uio_p, cred_t *cred_p)
{
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, getminor(dev));
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "read enter");
return (physio(usbskel_strategy, NULL, dev, B_READ,
usbskel_minphys, uio_p));
}
static int
usbskel_strategy(struct buf *bp)
{
usbskel_state_t *usbskelp = ddi_get_soft_state(usbskel_statep,
getminor(bp->b_edev));
usb_pipe_handle_t pipe = usbskelp->usbskel_reg->dev_default_ph;
usb_ctrl_req_t *request;
int status;
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "strategy enter");
bp->b_resid = bp->b_bcount;
if (bp->b_flags & (B_PHYS | B_PAGEIO)) {
bp_mapin(bp);
}
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
if (usbskelp->usbskel_dev_state != USB_DEV_ONLINE) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_strategy: device can't be accessed");
mutex_exit(&usbskelp->usbskel_mutex);
goto fail;
}
mutex_exit(&usbskelp->usbskel_mutex);
if ((bp->b_private = request = usb_alloc_ctrl_req(
usbskelp->usbskel_dip, bp->b_bcount, USB_FLAGS_SLEEP)) ==
NULL) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_read: Error allocating request");
goto fail;
}
request->ctrl_bmRequestType =
USB_DEV_REQ_DEV_TO_HOST | USB_DEV_REQ_TYPE_STANDARD |
USB_DEV_REQ_RCPT_DEV;
request->ctrl_bRequest = USB_REQ_GET_DESCR;
request->ctrl_wValue = USB_DESCR_TYPE_SETUP_CFG | 0;
request->ctrl_wIndex = 0;
request->ctrl_wLength = bp->b_bcount;
request->ctrl_timeout = 3;
request->ctrl_attributes = USB_ATTRS_SHORT_XFER_OK;
request->ctrl_cb = usbskel_normal_callback;
request->ctrl_exc_cb = usbskel_exception_callback;
request->ctrl_client_private = (usb_opaque_t)bp;
if ((status = usb_pipe_ctrl_xfer(pipe, request, USB_FLAGS_NOSLEEP)) !=
USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_strategy: can't start transfer: status: %d",
status);
goto fail;
}
return (0);
fail:
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
bioerror(bp, EIO);
biodone(bp);
return (0);
}
static void
usbskel_minphys(struct buf *bp)
{
if (bp->b_bcount > USBSKEL_REQUEST_SIZE) {
bp->b_bcount = USBSKEL_REQUEST_SIZE;
}
minphys(bp);
}
static void
usbskel_normal_callback(usb_pipe_handle_t pipe, usb_ctrl_req_t *request)
{
struct buf *bp = (struct buf *)request->ctrl_client_private;
usbskel_state_t *usbskelp = ddi_get_soft_state(usbskel_statep,
getminor(bp->b_edev));
mblk_t *data = request->ctrl_data;
int amt_transferred = MBLKL(data);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "normal callback enter");
ASSERT((request->ctrl_cb_flags & USB_CB_INTR_CONTEXT) == 0);
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"at entry, b_bcount = %lu, b_resid = %lu, trans = %d", bp->b_bcount,
bp->b_resid, amt_transferred);
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
if (amt_transferred) {
bcopy(data->b_rptr, bp->b_un.b_addr, amt_transferred);
}
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"normal callback: transferring %d bytes from 0x%p to 0x%p",
amt_transferred, (void *)data, (void *)(bp->b_un.b_addr));
bp->b_private = NULL;
request->ctrl_client_private = NULL;
usb_free_ctrl_req(request);
bp->b_resid = bp->b_bcount - amt_transferred;
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"at exit, b_bcount = %lu, b_resid = %lu, trans = %d", bp->b_bcount,
bp->b_resid, amt_transferred);
biodone(bp);
}
static void
usbskel_exception_callback(usb_pipe_handle_t pipe, usb_ctrl_req_t *request)
{
struct buf *bp = (struct buf *)request->ctrl_client_private;
usbskel_state_t *usbskelp = ddi_get_soft_state(usbskel_statep,
getminor(bp->b_edev));
mblk_t *data = request->ctrl_data;
int amt_transferred = (data ? MBLKL(data) : 0);
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"at except cb entry, b_bcount = %lu, b_resid = %lu, trans = %d",
bp->b_bcount, bp->b_resid, amt_transferred);
ASSERT((request->ctrl_cb_flags & USB_CB_INTR_CONTEXT) == 0);
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
if (amt_transferred) {
bcopy(data, bp->b_un.b_addr, amt_transferred);
}
bp->b_resid = bp->b_bcount - amt_transferred;
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"exception cb: req = 0x%p, cr = %d\n\t cb_flags = 0x%x "
"data = 0x%p, amt xfered = %d", (void *)request,
request->ctrl_completion_reason, request->ctrl_cb_flags,
(void *)(request->ctrl_data), amt_transferred);
bp->b_private = NULL;
request->ctrl_client_private = NULL;
usb_free_ctrl_req(request);
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"at except cb exit, b_bcount = %lu, b_resid = %lu, trans = %d",
bp->b_bcount, bp->b_resid, amt_transferred);
bioerror(bp, EIO);
biodone(bp);
}
static int
usbskel_ioctl(dev_t dev, int cmd, intptr_t arg,
int mode, cred_t *cred_p, int *rval_p)
{
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, getminor(dev));
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "ioctl enter");
return (ENOTTY);
}
static int
usbskel_disconnect_callback(dev_info_t *dip)
{
int instance = ddi_get_instance(dip);
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, instance);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "disconnect: enter");
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
usbskelp->usbskel_dev_state = USB_DEV_DISCONNECTED;
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
return (USB_SUCCESS);
}
static int
usbskel_reconnect_callback(dev_info_t *dip)
{
int instance = ddi_get_instance(dip);
usbskel_state_t *usbskelp =
ddi_get_soft_state(usbskel_statep, instance);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "reconnect: enter");
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
usbskel_restore_device_state(dip, usbskelp);
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
return (USB_SUCCESS);
}
static void
usbskel_restore_device_state(dev_info_t *dip, usbskel_state_t *usbskelp)
{
int rval;
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_restore_device_state: enter");
ASSERT(mutex_owned(&usbskelp->usbskel_mutex));
ASSERT((usbskelp->usbskel_dev_state == USB_DEV_DISCONNECTED) ||
(usbskelp->usbskel_dev_state == USB_DEV_SUSPENDED));
mutex_exit(&usbskelp->usbskel_mutex);
if (usbskel_pm_busy_component(usbskelp) != DDI_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_restore_device_state: Error raising power");
goto fail;
}
if (usbskel_check_same_device(usbskelp) != USB_SUCCESS) {
goto fail;
}
mutex_enter(&usbskelp->usbskel_mutex);
if ((rval = usbskel_test_and_adjust_device_state(usbskelp)) !=
USB_SUCCESS) {
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_restore_device_state: "
"Error adjusting device: rval = %d", rval);
goto fail;
}
usbskelp->usbskel_dev_state = USB_DEV_ONLINE;
mutex_exit(&usbskelp->usbskel_mutex);
if (usbskelp->usbskel_pm) {
if (usb_handle_remote_wakeup(dip, USB_REMOTE_WAKEUP_ENABLE) !=
USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"device may or may not be accessible. "
"Please verify reconnection");
}
usbskel_pm_idle_component(usbskelp);
}
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_restore_device_state: end");
return;
fail:
mutex_enter(&usbskelp->usbskel_mutex);
usbskelp->usbskel_dev_state = USB_DEV_DISCONNECTED;
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_pm_idle_component(usbskelp);
mutex_enter(&usbskelp->usbskel_mutex);
}
static int
usbskel_cpr_suspend(dev_info_t *dip)
{
int instance = ddi_get_instance(dip);
usbskel_state_t *usbskelp = ddi_get_soft_state(usbskel_statep,
instance);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "suspend enter");
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
mutex_exit(&usbskelp->usbskel_mutex);
if (usbskel_pm_busy_component(usbskelp) != DDI_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"suspend: Error raising power");
usbskel_pm_idle_component(usbskelp);
return (USB_FAILURE);
}
mutex_enter(&usbskelp->usbskel_mutex);
if ((usbskelp->usbskel_drv_state & USBSKEL_OPEN) != 0) {
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"suspend: Device is open. Can't suspend");
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_pm_idle_component(usbskelp);
return (USB_FAILURE);
}
usbskelp->usbskel_dev_state = USB_DEV_SUSPENDED;
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
usbskel_pm_idle_component(usbskelp);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "suspend: success");
return (USB_SUCCESS);
}
static void
usbskel_cpr_resume(dev_info_t *dip)
{
int instance = ddi_get_instance(dip);
usbskel_state_t *usbskelp = ddi_get_soft_state(usbskel_statep,
instance);
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "resume: enter");
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_restore_device_state(dip, usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
}
static int
usbskel_test_and_adjust_device_state(usbskel_state_t *usbskelp)
{
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "test and adjust enter");
return (USB_SUCCESS);
}
static int
usbskel_open_pipes(usbskel_state_t *usbskelp)
{
int rval = USB_SUCCESS;
usb_pipe_policy_t pipe_policy;
usb_pipe_handle_t pipe_handle;
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "open_pipes enter");
bzero(&pipe_policy, sizeof (pipe_policy));
pipe_policy.pp_max_async_reqs = 2;
if ((rval = usb_pipe_open(usbskelp->usbskel_dip,
&usbskelp->usbskel_intr_ep_descr, &pipe_policy,
USB_FLAGS_SLEEP, &pipe_handle)) != USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_open_pipes: Error opening intr pipe: status = %d",
rval);
rval = USB_FAILURE;
}
mutex_enter(&usbskelp->usbskel_mutex);
usbskelp->usbskel_intr_ph = pipe_handle;
mutex_exit(&usbskelp->usbskel_mutex);
return (rval);
}
static void
usbskel_close_pipes(usbskel_state_t *usbskelp)
{
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "close_pipes enter");
if (usbskelp->usbskel_intr_ph) {
usb_pipe_handle_t pipe_handle = usbskelp->usbskel_intr_ph;
usbskelp->usbskel_intr_ph = NULL;
mutex_exit(&usbskelp->usbskel_mutex);
usb_pipe_close(usbskelp->usbskel_dip, pipe_handle,
USB_FLAGS_SLEEP, NULL, 0);
mutex_enter(&usbskelp->usbskel_mutex);
}
}
static int
usbskel_pm_busy_component(usbskel_state_t *usbskelp)
{
int rval = DDI_SUCCESS;
mutex_enter(&usbskelp->usbskel_mutex);
if (usbskelp->usbskel_pm != NULL) {
usbskelp->usbskel_pm->usbskel_pm_busy++;
mutex_exit(&usbskelp->usbskel_mutex);
if (pm_busy_component(usbskelp->usbskel_dip, 0) ==
DDI_SUCCESS) {
(void) pm_raise_power(
usbskelp->usbskel_dip, 0, USB_DEV_OS_FULL_PWR);
mutex_enter(&usbskelp->usbskel_mutex);
} else {
mutex_enter(&usbskelp->usbskel_mutex);
usbskelp->usbskel_pm->usbskel_pm_busy--;
rval = DDI_FAILURE;
}
}
mutex_exit(&usbskelp->usbskel_mutex);
return (rval);
}
static void
usbskel_pm_idle_component(usbskel_state_t *usbskelp)
{
mutex_enter(&usbskelp->usbskel_mutex);
if (usbskelp->usbskel_pm != NULL) {
mutex_exit(&usbskelp->usbskel_mutex);
if (pm_idle_component(usbskelp->usbskel_dip, 0) ==
DDI_SUCCESS) {
mutex_enter(&usbskelp->usbskel_mutex);
ASSERT(usbskelp->usbskel_pm->usbskel_pm_busy > 0);
usbskelp->usbskel_pm->usbskel_pm_busy--;
mutex_exit(&usbskelp->usbskel_mutex);
}
mutex_enter(&usbskelp->usbskel_mutex);
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_pm_idle_component: %d",
usbskelp->usbskel_pm->usbskel_pm_busy);
}
mutex_exit(&usbskelp->usbskel_mutex);
}
static int
usbskel_power(dev_info_t *dip, int comp, int level)
{
usbskel_state_t *usbskelp;
usbskel_power_t *pm;
int rval = USB_FAILURE;
usbskelp = ddi_get_soft_state(usbskel_statep, ddi_get_instance(dip));
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_power: enter: level = %d", level);
mutex_enter(&usbskelp->usbskel_mutex);
(void) usbskel_serialize_access(usbskelp, USBSKEL_SER_NOSIG);
if ((usbskelp->usbskel_dev_state == USB_DEV_DISCONNECTED) ||
(usbskelp->usbskel_dev_state == USB_DEV_SUSPENDED)) {
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_power: disconnected/suspended "
"dev_state=%d", usbskelp->usbskel_dev_state);
rval = USB_SUCCESS;
goto done;
}
if (usbskelp->usbskel_pm == NULL) {
goto done;
}
pm = usbskelp->usbskel_pm;
if (USB_DEV_PWRSTATE_OK(pm->usbskel_pwr_states, level)) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_power: illegal power level = %d "
"pwr_states: %x", level, pm->usbskel_pwr_states);
goto done;
}
switch (level) {
case USB_DEV_OS_PWR_OFF :
if (pm->usbskel_pm_busy) {
goto done;
}
if (usbskelp->usbskel_dev_state == USB_DEV_ONLINE) {
usbskelp->usbskel_dev_state = USB_DEV_PWRED_DOWN;
usbskelp->usbskel_pm->usbskel_current_power =
USB_DEV_OS_PWR_OFF;
} else {
rval = USB_SUCCESS;
}
break;
case USB_DEV_OS_FULL_PWR :
usbskelp->usbskel_dev_state = USB_DEV_ONLINE;
usbskelp->usbskel_pm->usbskel_current_power =
USB_DEV_OS_FULL_PWR;
break;
default:
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_power: power level %d not supported", level);
break;
}
done:
usbskel_release_access(usbskelp);
mutex_exit(&usbskelp->usbskel_mutex);
return ((rval == USB_SUCCESS) ? DDI_SUCCESS : DDI_FAILURE);
}
#ifdef USBSKEL_PM
static int
usbskel_init_power_mgmt(usbskel_state_t *usbskelp)
{
int rval = USB_FAILURE;
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "init_power_mgmt enter");
if (usb_handle_remote_wakeup(usbskelp->usbskel_dip,
USB_REMOTE_WAKEUP_ENABLE) == USB_SUCCESS) {
usbskel_power_t *usbskelpm;
uint_t pwr_states;
usbskelpm = kmem_zalloc(sizeof (usbskel_power_t), KM_SLEEP);
usbskelp->usbskel_pm = usbskelpm;
usbskelpm->usbskel_state = usbskelp;
usbskelpm->usbskel_pm_capabilities = 0;
usbskelpm->usbskel_current_power = USB_DEV_OS_FULL_PWR;
if ((rval = usb_create_pm_components(
usbskelp->usbskel_dip, &pwr_states)) == USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_LOG,
"usbskel_init_power_mgmt: created PM components");
usbskelpm->usbskel_pwr_states =
(uint8_t)pwr_states;
(void) pm_raise_power(
usbskelp->usbskel_dip, 0, USB_DEV_OS_FULL_PWR);
} else {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_init_power_mgmt: create_pm_compts failed");
}
} else {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_init_power_mgmt: failure enabling remote wakeup");
}
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "usbskel_init_power_mgmt: end");
return (rval);
}
static void
usbskel_destroy_power_mgmt(usbskel_state_t *usbskelp)
{
usbskel_log(usbskelp, USBSKEL_LOG_LOG, "destroy_power_mgmt enter");
ASSERT(!mutex_owned(&usbskelp->usbskel_mutex));
if (usbskelp->usbskel_pm) {
(void) usbskel_pm_busy_component(usbskelp);
mutex_enter(&usbskelp->usbskel_mutex);
if (usbskelp->usbskel_dev_state != USB_DEV_DISCONNECTED) {
int rval;
mutex_exit(&usbskelp->usbskel_mutex);
if ((rval = usb_handle_remote_wakeup(
usbskelp->usbskel_dip,
USB_REMOTE_WAKEUP_DISABLE)) !=
USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_destroy_power_mgmt: "
"Error disabling rmt wakeup: rval = %d",
rval);
}
} else {
mutex_exit(&usbskelp->usbskel_mutex);
}
pm_lower_power(usbskelp->usbskel_dip, 0, USB_DEV_OS_PWR_OFF);
usbskel_pm_idle_component(usbskelp);
kmem_free(usbskelp->usbskel_pm, sizeof (usbskel_power_t));
usbskelp->usbskel_pm = NULL;
}
}
#endif
static int
usbskel_serialize_access(usbskel_state_t *usbskelp, boolean_t waitsig)
{
int rval = 1;
ASSERT(mutex_owned(&usbskelp->usbskel_mutex));
while (usbskelp->usbskel_serial_inuse) {
if (waitsig == USBSKEL_SER_SIG) {
rval = cv_wait_sig(&usbskelp->usbskel_serial_cv,
&usbskelp->usbskel_mutex);
} else {
cv_wait(&usbskelp->usbskel_serial_cv,
&usbskelp->usbskel_mutex);
}
}
usbskelp->usbskel_serial_inuse = B_TRUE;
return (rval);
}
static void
usbskel_release_access(usbskel_state_t *usbskelp)
{
ASSERT(mutex_owned(&usbskelp->usbskel_mutex));
usbskelp->usbskel_serial_inuse = B_FALSE;
cv_broadcast(&usbskelp->usbskel_serial_cv);
}
static int
usbskel_check_same_device(usbskel_state_t *usbskelp)
{
usb_dev_descr_t *orig_usb_dev_descr;
usb_dev_descr_t usb_dev_descr;
mblk_t *pdata = NULL;
int rval;
char *buf;
usb_cr_t completion_reason;
usb_cb_flags_t cb_flags;
boolean_t match = B_TRUE;
usb_ctrl_setup_t setup = {
USB_DEV_REQ_DEV_TO_HOST | USB_DEV_REQ_TYPE_STANDARD |
USB_DEV_REQ_RCPT_DEV,
USB_REQ_GET_DESCR,
USB_DESCR_TYPE_SETUP_DEV,
0,
USB_DEV_DESCR_SIZE,
0
};
ASSERT(!mutex_owned(&usbskelp->usbskel_mutex));
orig_usb_dev_descr = usbskelp->usbskel_reg->dev_descr;
rval = usb_pipe_ctrl_xfer_wait(usbskelp->usbskel_reg->dev_default_ph,
&setup, &pdata, &completion_reason, &cb_flags, USB_FLAGS_SLEEP);
if (rval != USB_SUCCESS) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"usbskel_check_same_device: "
"getting device descriptor failed "
"rval=%d, cr=%d, cb=0x%x\n",
rval, completion_reason, cb_flags);
freemsg(pdata);
return (USB_FAILURE);
}
ASSERT(pdata != NULL);
(void) usb_parse_data("2cs4c3s4c", pdata->b_rptr,
MBLKL(pdata), &usb_dev_descr,
sizeof (usb_dev_descr_t));
freemsg(pdata);
pdata = NULL;
if (usb_dev_descr.bLength != USB_DEV_DESCR_SIZE) {
match = B_FALSE;
} else if (bcmp(orig_usb_dev_descr,
(char *)&usb_dev_descr, USB_DEV_DESCR_SIZE) != 0) {
match = B_FALSE;
}
if ((match == B_TRUE) &&
(usbskelp->usbskel_reg->dev_serial != NULL)) {
buf = kmem_alloc(USB_MAXSTRINGLEN, KM_SLEEP);
if (usb_get_string_descr(usbskelp->usbskel_dip, USB_LANG_ID,
usb_dev_descr.iSerialNumber, buf,
USB_MAXSTRINGLEN) == USB_SUCCESS) {
match =
(strcmp(buf,
usbskelp->usbskel_reg->dev_serial) == 0);
}
kmem_free(buf, USB_MAXSTRINGLEN);
}
if (match == B_FALSE) {
usbskel_log(usbskelp, USBSKEL_LOG_CONSOLE,
"Device is not identical to the "
"previous one this port.\n"
"Please disconnect and reconnect");
return (USB_INVALID_VERSION);
}
return (USB_SUCCESS);
}
static void
usbskel_log(usbskel_state_t *usbskelp, int msglevel, char *formatarg, ...)
{
va_list ap;
if (msglevel <= usbskel_errlevel) {
char *format;
int formatlen = strlen(formatarg) + 2;
int devinst_start = 0;
if (usbskelp != NULL) {
formatlen += strlen(usbskelp->usbskel_devinst);
}
format = kmem_zalloc(formatlen, KM_SLEEP);
if (msglevel == USBSKEL_LOG_LOG) {
format[0] = '!';
devinst_start = 1;
}
if (usbskelp != NULL) {
(void) strcpy(&format[devinst_start],
usbskelp->usbskel_devinst);
}
va_start(ap, formatarg);
(void) strcat(format, formatarg);
vcmn_err(CE_CONT, format, ap);
va_end(ap);
kmem_free(format, formatlen);
}
}