#include <sys/param.h>
#include <sys/errno.h>
#include <sys/cred.h>
#include <sys/conf.h>
#include <sys/modctl.h>
#include <sys/stat.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/1394/targets/av1394/av1394_impl.h>
static int av1394_getinfo(dev_info_t *, ddi_info_cmd_t, void *, void **);
static int av1394_attach(dev_info_t *, ddi_attach_cmd_t);
static int av1394_detach(dev_info_t *, ddi_detach_cmd_t);
static int av1394_open(dev_t *, int, int, cred_t *);
static int av1394_close(dev_t, int, int, cred_t *);
static int av1394_read(dev_t, struct uio *, cred_t *);
static int av1394_write(dev_t, struct uio *, cred_t *);
static int av1394_ioctl(dev_t, int, intptr_t, int, cred_t *, int *);
static int av1394_devmap(dev_t, devmap_cookie_t, offset_t, size_t,
size_t *, uint_t);
static int av1394_poll(dev_t, short, int, short *, struct pollhead **);
static void av1394_cleanup(av1394_inst_t *, int);
static int av1394_t1394_attach(av1394_inst_t *, dev_info_t *);
static void av1394_t1394_detach(av1394_inst_t *);
static int av1394_add_events(av1394_inst_t *);
static void av1394_remove_events(av1394_inst_t *);
static int av1394_cpr_suspend(av1394_inst_t *);
static int av1394_cpr_resume(av1394_inst_t *);
static void av1394_bus_reset(dev_info_t *, ddi_eventcookie_t, void *,
void *);
static void av1394_disconnect(dev_info_t *, ddi_eventcookie_t, void *,
void *);
static void av1394_reconnect(dev_info_t *, ddi_eventcookie_t, void *,
void *);
extern struct mod_ops mod_driverops;
struct cb_ops av1394_cb_ops = {
av1394_open,
av1394_close,
nulldev,
nulldev,
nulldev,
av1394_read,
av1394_write,
av1394_ioctl,
av1394_devmap,
nulldev,
nulldev,
av1394_poll,
ddi_prop_op,
NULL,
D_MP | D_NEW | D_HOTPLUG | D_DEVMAP
};
static struct dev_ops av1394_ops = {
DEVO_REV,
0,
av1394_getinfo,
nulldev,
nulldev,
av1394_attach,
av1394_detach,
nodev,
&av1394_cb_ops,
NULL,
NULL,
ddi_quiesce_not_supported,
};
static struct modldrv av1394_modldrv = {
&mod_driverops,
"IEEE 1394 AV driver",
&av1394_ops
};
static struct modlinkage av1394_modlinkage = {
MODREV_1,
&av1394_modldrv,
NULL,
};
static void *av1394_statep;
#define AV1394_INST2STATE(inst) (ddi_get_soft_state(av1394_statep, inst))
#define AV1394_DEV2STATE(dev) \
(ddi_get_soft_state(av1394_statep, AV1394_DEV2INST(dev)))
int
_init(void)
{
int error;
error = ddi_soft_state_init(&av1394_statep, sizeof (av1394_inst_t), 1);
if (error != 0) {
return (error);
}
if ((error = mod_install(&av1394_modlinkage)) != 0) {
ddi_soft_state_fini(&av1394_statep);
}
return (error);
}
int
_fini(void)
{
int error;
if ((error = mod_remove(&av1394_modlinkage)) == 0) {
ddi_soft_state_fini(&av1394_statep);
}
return (error);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&av1394_modlinkage, modinfop));
}
static int
av1394_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int instance = ddi_get_instance(dip);
av1394_inst_t *avp;
switch (cmd) {
case DDI_ATTACH:
break;
case DDI_RESUME:
if ((avp = AV1394_INST2STATE(instance)) == NULL) {
return (DDI_FAILURE);
}
return (av1394_cpr_resume(avp));
default:
return (DDI_FAILURE);
}
if (ddi_soft_state_zalloc(av1394_statep, instance) != 0) {
return (DDI_FAILURE);
}
avp = AV1394_INST2STATE(instance);
if (av1394_t1394_attach(avp, dip) != DDI_SUCCESS) {
av1394_cleanup(avp, 1);
return (DDI_FAILURE);
}
mutex_init(&avp->av_mutex, NULL, MUTEX_DRIVER,
avp->av_attachinfo.iblock_cookie);
#ifndef __lock_lint
avp->av_dip = dip;
avp->av_instance = instance;
#endif
if (av1394_add_events(avp) != DDI_SUCCESS) {
av1394_cleanup(avp, 2);
return (DDI_FAILURE);
}
if (av1394_isoch_attach(avp) != DDI_SUCCESS) {
av1394_cleanup(avp, 3);
return (DDI_FAILURE);
}
if (av1394_async_attach(avp) != DDI_SUCCESS) {
av1394_cleanup(avp, 4);
return (DDI_FAILURE);
}
#ifndef __lock_lint
avp->av_dev_state = AV1394_DEV_ONLINE;
#endif
ddi_report_dev(dip);
return (DDI_SUCCESS);
}
static int
av1394_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
int instance = ddi_get_instance(dip);
av1394_inst_t *avp;
if ((avp = AV1394_INST2STATE(instance)) == NULL) {
return (DDI_FAILURE);
}
switch (cmd) {
case DDI_DETACH:
av1394_cleanup(avp, AV1394_CLEANUP_LEVEL_MAX);
return (DDI_SUCCESS);
case DDI_SUSPEND:
return (av1394_cpr_suspend(avp));
default:
return (DDI_FAILURE);
}
}
static int
av1394_getinfo(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg,
void **result)
{
dev_t dev = (dev_t)arg;
av1394_inst_t *avp;
int rval = DDI_FAILURE;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
if ((avp = AV1394_DEV2STATE(dev)) != NULL) {
*result = avp->av_dip;
rval = DDI_SUCCESS;
} else {
*result = NULL;
}
break;
case DDI_INFO_DEVT2INSTANCE:
*result = (void *)(uintptr_t)AV1394_DEV2INST(dev);
rval = DDI_SUCCESS;
break;
}
return (rval);
}
static int
av1394_open(dev_t *dev, int flag, int otyp, cred_t *cr)
{
av1394_inst_t *avp = AV1394_DEV2STATE(*dev);
int ret = ENXIO;
if (avp != NULL) {
if (AV1394_DEV_IS_ISOCH(*dev)) {
ret = 0;
} else if (AV1394_DEV_IS_ASYNC(*dev)) {
ret = av1394_async_open(avp, flag);
}
}
return (ret);
}
static int
av1394_close(dev_t dev, int flag, int otyp, cred_t *cr)
{
av1394_inst_t *avp = AV1394_DEV2STATE(dev);
int ret = ENXIO;
if (avp != NULL) {
if (AV1394_DEV_IS_ISOCH(dev)) {
ret = av1394_isoch_close(avp, flag);
} else if (AV1394_DEV_IS_ASYNC(dev)) {
ret = av1394_async_close(avp, flag);
}
}
return (ret);
}
static int
av1394_read(dev_t dev, struct uio *uiop, cred_t *cr)
{
av1394_inst_t *avp = AV1394_DEV2STATE(dev);
int ret = ENXIO;
if (avp != NULL) {
if (AV1394_DEV_IS_ISOCH(dev)) {
ret = av1394_isoch_read(avp, uiop);
} else if (AV1394_DEV_IS_ASYNC(dev)) {
ret = av1394_async_read(avp, uiop);
}
}
return (ret);
}
static int
av1394_write(dev_t dev, struct uio *uiop, cred_t *cr)
{
av1394_inst_t *avp = AV1394_DEV2STATE(dev);
int ret = ENXIO;
if (avp != NULL) {
if (AV1394_DEV_IS_ISOCH(dev)) {
ret = av1394_isoch_write(avp, uiop);
} else if (AV1394_DEV_IS_ASYNC(dev)) {
ret = av1394_async_write(avp, uiop);
}
}
return (ret);
}
static int
av1394_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *cr, int *rvalp)
{
av1394_inst_t *avp = AV1394_DEV2STATE(dev);
int ret = ENXIO;
if (avp != NULL) {
if (AV1394_DEV_IS_ISOCH(dev)) {
ret = av1394_isoch_ioctl(avp, cmd, arg, mode, rvalp);
} else if (AV1394_DEV_IS_ASYNC(dev)) {
ret = av1394_async_ioctl(avp, cmd, arg, mode, rvalp);
}
}
return (ret);
}
static int
av1394_devmap(dev_t dev, devmap_cookie_t dhp, offset_t off, size_t len,
size_t *maplen, uint_t model)
{
av1394_inst_t *avp = AV1394_DEV2STATE(dev);
int ret = ENXIO;
if ((avp != NULL) && (AV1394_DEV_IS_ISOCH(dev))) {
ret = av1394_isoch_devmap(avp, dhp, off, len, maplen, model);
}
return (ret);
}
static int
av1394_poll(dev_t dev, short events, int anyyet, short *reventsp,
struct pollhead **phpp)
{
av1394_inst_t *avp = AV1394_DEV2STATE(dev);
int ret = ENXIO;
if ((avp != NULL) && AV1394_DEV_IS_ASYNC(dev)) {
ret = av1394_async_poll(avp, events, anyyet, reventsp, phpp);
}
return (ret);
}
static void
av1394_cleanup(av1394_inst_t *avp, int level)
{
ASSERT((level > 0) && (level <= AV1394_CLEANUP_LEVEL_MAX));
switch (level) {
default:
av1394_async_detach(avp);
case 4:
av1394_isoch_detach(avp);
case 3:
av1394_remove_events(avp);
case 2:
av1394_t1394_detach(avp);
mutex_destroy(&avp->av_mutex);
case 1:
ddi_soft_state_free(av1394_statep, avp->av_instance);
}
}
static int
av1394_t1394_attach(av1394_inst_t *avp, dev_info_t *dip)
{
int ret;
ret = t1394_attach(dip, T1394_VERSION_V1, 0, &avp->av_attachinfo,
&avp->av_t1394_hdl);
return (ret);
}
static void
av1394_t1394_detach(av1394_inst_t *avp)
{
(void) t1394_detach(&avp->av_t1394_hdl, 0);
}
static int
av1394_add_events(av1394_inst_t *avp)
{
ddi_eventcookie_t br_evc, rem_evc, ins_evc;
if (ddi_get_eventcookie(avp->av_dip, DDI_DEVI_BUS_RESET_EVENT,
&br_evc) != DDI_SUCCESS) {
return (DDI_FAILURE);
}
if (ddi_add_event_handler(avp->av_dip, br_evc, av1394_bus_reset,
avp, &avp->av_reset_cb) != DDI_SUCCESS) {
return (DDI_FAILURE);
}
if (ddi_get_eventcookie(avp->av_dip, DDI_DEVI_REMOVE_EVENT,
&rem_evc) != DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_reset_cb);
return (DDI_FAILURE);
}
if (ddi_add_event_handler(avp->av_dip, rem_evc, av1394_disconnect,
avp, &avp->av_remove_cb) != DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_reset_cb);
return (DDI_FAILURE);
}
if (ddi_get_eventcookie(avp->av_dip, DDI_DEVI_INSERT_EVENT,
&ins_evc) != DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_remove_cb);
(void) ddi_remove_event_handler(avp->av_reset_cb);
return (DDI_FAILURE);
}
if (ddi_add_event_handler(avp->av_dip, ins_evc, av1394_reconnect,
avp, &avp->av_insert_cb) != DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_remove_cb);
(void) ddi_remove_event_handler(avp->av_reset_cb);
return (DDI_FAILURE);
}
return (DDI_SUCCESS);
}
static void
av1394_remove_events(av1394_inst_t *avp)
{
ddi_eventcookie_t evc;
if (ddi_get_eventcookie(avp->av_dip, DDI_DEVI_INSERT_EVENT,
&evc) == DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_insert_cb);
}
if (ddi_get_eventcookie(avp->av_dip, DDI_DEVI_REMOVE_EVENT,
&evc) == DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_remove_cb);
}
if (ddi_get_eventcookie(avp->av_dip, DDI_DEVI_BUS_RESET_EVENT,
&evc) == DDI_SUCCESS) {
(void) ddi_remove_event_handler(avp->av_reset_cb);
}
}
static int
av1394_cpr_suspend(av1394_inst_t *avp)
{
int ret;
ret = av1394_isoch_cpr_suspend(avp);
if (ret == DDI_SUCCESS) {
mutex_enter(&avp->av_mutex);
avp->av_prev_dev_state = avp->av_dev_state;
avp->av_dev_state = AV1394_DEV_SUSPENDED;
mutex_exit(&avp->av_mutex);
}
return (ret);
}
static int
av1394_cpr_resume(av1394_inst_t *avp)
{
mutex_enter(&avp->av_mutex);
avp->av_dev_state = avp->av_prev_dev_state;
mutex_exit(&avp->av_mutex);
(void) av1394_async_cpr_resume(avp);
return (DDI_SUCCESS);
}
static void
av1394_bus_reset(dev_info_t *dip, ddi_eventcookie_t evc, void *arg, void *data)
{
av1394_inst_t *avp = arg;
if (avp == NULL) {
return;
}
mutex_enter(&avp->av_mutex);
avp->av_attachinfo.localinfo = *(t1394_localinfo_t *)data;
mutex_exit(&avp->av_mutex);
av1394_async_bus_reset(avp);
av1394_cmp_bus_reset(avp);
}
static void
av1394_disconnect(dev_info_t *dip, ddi_eventcookie_t evc, void *arg, void *data)
{
av1394_inst_t *avp = arg;
if (avp == NULL) {
return;
}
mutex_enter(&avp->av_mutex);
avp->av_dev_state = AV1394_DEV_DISCONNECTED;
mutex_exit(&avp->av_mutex);
}
static void
av1394_reconnect(dev_info_t *dip, ddi_eventcookie_t evc, void *arg, void *data)
{
av1394_inst_t *avp = arg;
if (avp == NULL) {
return;
}
mutex_enter(&avp->av_mutex);
avp->av_dev_state = AV1394_DEV_ONLINE;
avp->av_attachinfo.localinfo = *(t1394_localinfo_t *)data;
mutex_exit(&avp->av_mutex);
av1394_async_reconnect(avp);
}