#include <sys/types.h>
#include <sys/cred.h>
#include <sys/mman.h>
#include <sys/kmem.h>
#include <sys/conf.h>
#include <sys/ddi.h>
#include <sys/sunddi.h>
#include <sys/sunndi.h>
#include <sys/ddi_impldefs.h>
#include <sys/ndi_impldefs.h>
#include <sys/modctl.h>
#include <sys/stat.h>
#include <sys/fcode.h>
static int fc_max_opens = 32;
static struct fc_state {
int state;
struct fc_request *req;
} *fc_states;
#define FC_STATE_INACTIVE 0
#define FC_STATE_OPEN 1
#define FC_STATE_READ_DONE 2
#define FC_STATE_IN_PROGRESS 3
#define FC_STATE_VALIDATED 4
#define FC_STATE_ERROR_SET 5
#define FC_STATE_ACTIVE(s) ((s) != 0)
#define FC_STATE_AVAILABLE(s) ((s) == FC_STATE_INACTIVE)
static kmutex_t fc_open_lock;
static kcondvar_t fc_open_cv;
static int fc_open_count;
static int fc_open(dev_t *, int, int, cred_t *);
static int fc_close(dev_t, int, int, cred_t *);
static int fc_read(dev_t, struct uio *, cred_t *);
static int fc_ioctl(dev_t, int, intptr_t, int, cred_t *, int *);
static int fc_info(dev_info_t *, ddi_info_cmd_t, void *, void **);
static int fc_attach(dev_info_t *, ddi_attach_cmd_t cmd);
static int fc_detach(dev_info_t *, ddi_detach_cmd_t cmd);
static int fc_get_parameters(dev_t, intptr_t, int, cred_t *, int *);
static int fc_get_my_args(dev_t, intptr_t, int, cred_t *, int *);
static int fc_run_priv(dev_t, intptr_t, int, cred_t *, int *);
static int fc_validate(dev_t, intptr_t, int, cred_t *, int *);
static int fc_get_fcode(dev_t, intptr_t, int, cred_t *, int *);
static int fc_set_fcode_error(dev_t, intptr_t, int, cred_t *, int *);
static struct cb_ops fc_cb_ops = {
fc_open,
fc_close,
nodev,
nodev,
nodev,
fc_read,
nodev,
fc_ioctl,
nodev,
nodev,
nodev,
nochpoll,
ddi_prop_op,
NULL,
D_NEW | D_MP
};
static struct dev_ops fcode_ops = {
DEVO_REV,
0,
fc_info,
nulldev,
nulldev,
fc_attach,
fc_detach,
nodev,
&fc_cb_ops,
NULL,
NULL,
ddi_quiesce_not_needed,
};
static struct modldrv modldrv = {
&mod_driverops,
"FCode driver",
&fcode_ops
};
static struct modlinkage modlinkage = {
MODREV_1,
&modldrv,
NULL
};
int
_init(void)
{
int error;
mutex_init(&fc_open_lock, NULL, MUTEX_DRIVER, NULL);
cv_init(&fc_open_cv, NULL, CV_DRIVER, NULL);
error = mod_install(&modlinkage);
if (error != 0) {
mutex_destroy(&fc_open_lock);
cv_destroy(&fc_open_cv);
return (error);
}
return (0);
}
int
_info(struct modinfo *modinfop)
{
return (mod_info(&modlinkage, modinfop));
}
int
_fini(void)
{
int error;
error = mod_remove(&modlinkage);
if (error != 0) {
return (error);
}
mutex_destroy(&fc_open_lock);
cv_destroy(&fc_open_cv);
return (0);
}
static dev_info_t *fc_dip;
static int
fc_info(dev_info_t *dip, ddi_info_cmd_t infocmd, void *arg, void **result)
{
int error = DDI_FAILURE;
switch (infocmd) {
case DDI_INFO_DEVT2DEVINFO:
*result = (void *)fc_dip;
error = DDI_SUCCESS;
break;
case DDI_INFO_DEVT2INSTANCE:
*result = (void *)0;
error = DDI_SUCCESS;
break;
default:
break;
}
return (error);
}
static int
fc_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
{
int error = DDI_FAILURE;
switch (cmd) {
case DDI_ATTACH:
fc_open_count = 0;
fc_states = kmem_zalloc(
fc_max_opens * sizeof (struct fc_state), KM_SLEEP);
if (ddi_create_minor_node(dip, "fcode", S_IFCHR,
0, DDI_PSEUDO, 0) == DDI_FAILURE) {
kmem_free(fc_states,
fc_max_opens * sizeof (struct fc_state));
error = DDI_FAILURE;
} else {
fc_dip = dip;
ddi_report_dev(dip);
error = DDI_SUCCESS;
}
break;
default:
error = DDI_FAILURE;
break;
}
return (error);
}
static int
fc_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
{
int error = DDI_FAILURE;
switch (cmd) {
case DDI_DETACH:
ddi_remove_minor_node(dip, NULL);
fc_dip = NULL;
kmem_free(fc_states, fc_max_opens * sizeof (struct fc_state));
error = DDI_SUCCESS;
break;
default:
error = DDI_FAILURE;
break;
}
return (error);
}
static int
fc_open(dev_t *devp, int flag, int otyp, cred_t *credp)
{
int m;
struct fc_state *st;
if (getminor(*devp) != 0)
return (EINVAL);
mutex_enter(&fc_open_lock);
while (fc_open_count >= fc_max_opens) {
FC_DEBUG0(1, CE_WARN,
"fcode: Maximum fcode open reached, waiting for exit\n");
if (cv_wait_sig(&fc_open_cv, &fc_open_lock) == 0) {
mutex_exit(&fc_open_lock);
return (EINTR);
}
}
fc_open_count++;
for (m = 0, st = fc_states; m < fc_max_opens; m++, st++) {
if (FC_STATE_ACTIVE(st->state))
continue;
st->state = FC_STATE_OPEN;
st->req = 0;
break;
}
mutex_exit(&fc_open_lock);
ASSERT(m < fc_max_opens);
*devp = makedevice(getmajor(*devp), (minor_t)(m + 1));
FC_DEBUG2(9, CE_CONT, "fc_open: open count = %d (%d)\n",
fc_open_count, m + 1);
return (0);
}
static int
fc_close(dev_t dev, int flag, int otype, cred_t *cred_p)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
struct fc_request *fp;
struct fc_client_interface *cp;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state == FC_STATE_READ_DONE) {
fp = st->req;
fp->error = FC_ERROR;
}
if (st->state > FC_STATE_READ_DONE) {
cp = kmem_zalloc(sizeof (struct fc_client_interface), KM_SLEEP);
fp = st->req;
ASSERT(fp);
ASSERT(fp->ap_ops);
if (st->state != FC_STATE_VALIDATED) {
FC_DEBUG0(1, CE_CONT,
"fc_close: Send invalidate cmd\n");
cp->svc_name = fc_ptr2cell(FC_SVC_INVALIDATE);
(void) fp->ap_ops(fp->ap_dip, fp->handle, cp);
if ((st->state != FC_STATE_ERROR_SET) ||
(fp->error == FC_SUCCESS)) {
fp->error = FC_ERROR;
}
}
bzero(cp, sizeof (struct fc_client_interface));
FC_DEBUG0(9, CE_CONT, "fc_close: Sending exit cmd\n");
cp->svc_name = fc_ptr2cell(FC_SVC_EXIT);
(void) fp->ap_ops(fp->ap_dip, fp->handle, cp);
kmem_free(cp, sizeof (struct fc_client_interface));
}
if ((fp = st->req) != NULL)
fc_finish_request(fp);
mutex_enter(&fc_open_lock);
st->state = FC_STATE_INACTIVE;
st->req = 0;
FC_DEBUG2(9, CE_CONT, "fc_close: open count = %d (%d)\n",
fc_open_count, m + 1);
if (fc_open_count >= fc_max_opens) {
cv_broadcast(&fc_open_cv);
}
fc_open_count--;
mutex_exit(&fc_open_lock);
return (0);
}
static int
fc_read(dev_t dev, struct uio *uio, cred_t *cred)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
struct fc_request *fp;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_OPEN) {
cmn_err(CE_CONT, "fc_read: Wrong state (%d) for read\n",
st->state);
return (EINVAL);
}
if ((fp = fc_get_request()) == NULL)
return (EINTR);
FC_DEBUG1(3, CE_CONT, "fc_read: request fp: %p\n", fp);
mutex_enter(&fc_open_lock);
st->req = fp;
st->state = FC_STATE_READ_DONE;
mutex_exit(&fc_open_lock);
return (0);
}
static int
fc_ioctl(dev_t dev, int cmd, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
if (m >= fc_max_opens) {
return (EINVAL);
}
st = fc_states + m;
ASSERT(FC_STATE_ACTIVE(st->state));
switch (cmd) {
case FC_GET_PARAMETERS:
return (fc_get_parameters(dev, arg, mode, credp, rvalp));
case FC_GET_MY_ARGS:
return (fc_get_my_args(dev, arg, mode, credp, rvalp));
case FC_RUN_PRIV:
return (fc_run_priv(dev, arg, mode, credp, rvalp));
case FC_VALIDATE:
return (fc_validate(dev, arg, mode, credp, rvalp));
case FC_GET_FCODE_DATA:
return (fc_get_fcode(dev, arg, mode, credp, rvalp));
case FC_SET_FCODE_ERROR:
return (fc_set_fcode_error(dev, arg, mode, credp, rvalp));
}
return (ENOTTY);
}
static int
fc_get_parameters(dev_t dev, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
fco_handle_t rp;
struct fc_parameters *fcp;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_READ_DONE) {
cmn_err(CE_CONT, "fc_ioctl: fc_get_parameters: "
"wrong state (%d)\n", st->state);
return (EINVAL);
}
ASSERT(st->req != NULL);
rp = st->req->handle;
FC_DEBUG1(3, CE_CONT, "fc_ioctl: fc_get_parameters fp: %p\n", st->req);
fcp = kmem_zalloc(sizeof (struct fc_parameters), KM_SLEEP);
fcp->fcode_size = rp->fcode_size;
(void) strncpy(fcp->unit_address, rp->unit_address,
sizeof (fcp->unit_address) - 1);
if (rp->bus_args) {
bcopy(rp->bus_args, &fcp->config_address, sizeof (int));
FC_DEBUG1(3, CE_CONT, "fc_ioctl: config_address=%x\n",
fcp->config_address);
} else {
FC_DEBUG0(3, CE_CONT, "fc_ioctl: fc_get_parameters "
"There are no bus specific arguments\n");
}
if (copyout(fcp, (void *)arg, sizeof (struct fc_parameters)) == -1) {
kmem_free(fcp, sizeof (struct fc_parameters));
return (EFAULT);
}
kmem_free(fcp, sizeof (struct fc_parameters));
mutex_enter(&fc_open_lock);
st->state = FC_STATE_IN_PROGRESS;
mutex_exit(&fc_open_lock);
return (0);
}
static int
fc_get_my_args(dev_t dev, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
fco_handle_t rp;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_IN_PROGRESS) {
cmn_err(CE_CONT, "fc_ioctl: fc_get_my_args: "
"wrong state (%d)\n", st->state);
return (EINVAL);
}
ASSERT(st->req != NULL);
rp = st->req->handle;
FC_DEBUG1(3, CE_CONT, "fc_ioctl: fc_get_my_args fp: %p\n", st->req);
if (rp->my_args == NULL) {
FC_DEBUG0(3, CE_CONT, "fc_ioctl: fc_get_my_args "
"There are no bus specific my-args\n");
return (EINVAL);
}
if (strlen(rp->my_args) > FC_GET_MY_ARGS_BUFLEN) {
FC_DEBUG1(3, CE_CONT, "fc_ioctl: fc_get_my_args "
"my-args is larger than %d\n", FC_GET_MY_ARGS_BUFLEN);
return (EINVAL);
}
if (copyout(rp->my_args, (void *)arg, strlen(rp->my_args) + 1) == -1) {
return (EFAULT);
}
return (0);
}
static int
fc_run_priv(dev_t dev, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
struct fc_request *fp;
struct fc_client_interface tc, *cp, *ap;
size_t csize;
int nresults, nargs, error;
char *name;
ap = (struct fc_client_interface *)arg;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_IN_PROGRESS) {
cmn_err(CE_CONT, "fc_ioctl: fc_run_priv: wrong state (%d)\n",
st->state);
return (EINVAL);
}
if (copyin((void *)arg, &tc, 3 * sizeof (fc_cell_t))) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_run_priv "
"fault copying in first 2 cells from %p\n", arg);
return (EFAULT);
}
nresults = fc_cell2int(tc.nresults);
nargs = fc_cell2int(tc.nargs);
csize = (FCC_FIXED_CELLS + nargs + nresults) * sizeof (fc_cell_t);
cp = kmem_zalloc(csize, KM_SLEEP);
if (copyin((void *)arg, cp, csize - (nresults * sizeof (fc_cell_t)))) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_run_priv "
"fault copying in argument array from %p\n", arg);
kmem_free(cp, csize);
return (EFAULT);
}
cp->error = fc_int2cell(0);
cp->priv_error = fc_int2cell(0);
name = kmem_zalloc(FC_SVC_NAME_LEN, KM_SLEEP);
if (copyinstr(fc_cell2ptr(cp->svc_name), name,
FC_SVC_NAME_LEN - 1, NULL)) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_run_priv "
"fault copying in service name from %p\n",
fc_cell2ptr(cp->svc_name));
kmem_free(cp, csize);
kmem_free(name, FC_SVC_NAME_LEN);
return (EFAULT);
}
cp->svc_name = fc_ptr2cell(name);
FC_DEBUG3(7, CE_CONT, "fc_ioctl: fc_run_priv: "
"service name <%s> nargs %d nresults %d\n",
name, fc_cell2int(cp->nargs), fc_cell2int(cp->nresults));
fp = st->req;
ASSERT(fp->ap_ops);
error = fp->ap_ops(fp->ap_dip, fp->handle, cp);
if (error || cp->error) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_run_priv: "
"service name <%s> was unserviced\n", name);
cp->error = FC_ERR_SVC_NAME;
cp->nresults = fc_int2cell(0);
error = copyout(&cp->error, &ap->error, sizeof (fc_cell_t));
error |= copyout(&cp->nresults, &ap->nresults,
sizeof (fc_cell_t));
kmem_free(cp, csize);
kmem_free(name, FC_SVC_NAME_LEN);
if (error) {
FC_DEBUG0(1, CE_CONT, "fc_ioctl: fc_run_priv "
"fault copying out error result\n");
return (EFAULT);
}
return (0);
}
if (cp->priv_error) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_run_priv: "
"service name <%s> caused a priv violation\n", name);
cp->priv_error = FC_PRIV_ERROR;
cp->nresults = fc_int2cell(0);
error = copyout(&cp->error, &ap->error, sizeof (fc_cell_t));
error |= copyout(&cp->priv_error, &ap->priv_error,
sizeof (fc_cell_t));
error |= copyout(&cp->nresults, &ap->nresults,
sizeof (fc_cell_t));
kmem_free(cp, csize);
kmem_free(name, FC_SVC_NAME_LEN);
if (error) {
FC_DEBUG0(1, CE_CONT, "fc_ioctl: fc_run_priv "
"fault copying out priv error result\n");
return (EFAULT);
}
return (0);
}
if (fc_cell2int(cp->nresults) > nresults)
cmn_err(CE_PANIC, "fc_ioctl: fc_run_priv: "
"results (from ops function) overflow\n");
error = copyout(&cp->nresults, &ap->nresults, sizeof (fc_cell_t));
error |= copyout(&cp->error, &ap->error, sizeof (fc_cell_t));
error |= copyout(&cp->priv_error, &ap->priv_error, sizeof (fc_cell_t));
if ((error == 0) && cp->nresults)
error |= copyout(&fc_result(cp, 0), &(ap->v[nargs]),
cp->nresults * sizeof (fc_cell_t));
kmem_free(cp, csize);
kmem_free(name, FC_SVC_NAME_LEN);
if (error) {
FC_DEBUG0(1, CE_CONT, "fc_ioctl: fc_run_priv "
"fault copying out (good) results\n");
return (EFAULT);
}
return (0);
}
static int
fc_validate(dev_t dev, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
struct fc_request *fp;
struct fc_client_interface *cp;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_IN_PROGRESS) {
cmn_err(CE_CONT, "fc_ioctl: fc_validate: wrong state (%d)\n",
st->state);
return (EINVAL);
}
FC_DEBUG0(2, CE_CONT, "fc_ioctl: fc_validate: Sending validate cmd\n");
cp = kmem_zalloc(sizeof (struct fc_client_interface), KM_SLEEP);
cp->svc_name = fc_ptr2cell(FC_SVC_VALIDATE);
fp = st->req;
ASSERT(fp->ap_ops);
(void) fp->ap_ops(fp->ap_dip, fp->handle, cp);
kmem_free(cp, sizeof (struct fc_client_interface));
mutex_enter(&fc_open_lock);
st->state = FC_STATE_VALIDATED;
mutex_exit(&fc_open_lock);
return (0);
}
static int
fc_get_fcode(dev_t dev, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
int m = (int)getminor(dev) - 1;
fco_handle_t rp;
struct fc_fcode_info fcode_info;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_IN_PROGRESS) {
cmn_err(CE_CONT, "fc_ioctl: fc_get_fcode: wrong state (%d)\n",
st->state);
return (EINVAL);
}
ASSERT(st->req != NULL);
rp = st->req->handle;
FC_DEBUG1(3, CE_CONT, "fc_ioctl: fc_get_fcode fp: %p\n", st->req);
if (copyin((void *)arg, &fcode_info, sizeof (fc_fcode_info_t))) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_get_fcode "
"fault copying in fcode_info from %p\n", arg);
return (EFAULT);
}
if (fcode_info.fcode_size != rp->fcode_size) {
FC_DEBUG2(1, CE_CONT, "fc_ioctl: fc_get_fcode "
"requested size (0x%x) doesn't match real size (0x%x)\n",
fcode_info.fcode_size, rp->fcode_size);
return (EINVAL);
}
if (copyout(rp->fcode, fcode_info.fcode_ptr, rp->fcode_size) == -1) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_get_fcode "
"fault copying out fcode to %p\n", fcode_info.fcode_ptr);
return (EFAULT);
}
return (0);
}
static int
fc_set_fcode_error(dev_t dev, intptr_t arg, int mode, cred_t *credp, int *rvalp)
{
struct fc_state *st;
struct fc_request *fp;
int m = (int)getminor(dev) - 1;
int status;
st = fc_states + m;
ASSERT(m < fc_max_opens && FC_STATE_ACTIVE(st->state));
if (st->state != FC_STATE_IN_PROGRESS) {
cmn_err(CE_CONT,
"fc_ioctl:fc_set_fcode_error: wrong state (%d)\n",
st->state);
return (EINVAL);
}
ASSERT(st->req != NULL);
fp = st->req;
FC_DEBUG1(3, CE_CONT, "fc_ioctl: fc_set_fcode_error fp: %p\n", fp);
if (copyin((void *)arg, &status, sizeof (int))) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_set_fcode_error "
"fault copying in status from %p\n", arg);
return (EFAULT);
}
if (!FC_ERROR_VALID(status)) {
FC_DEBUG1(1, CE_CONT, "fc_ioctl: fc_set_fcode_error "
"invalid error code specified %i\n", status);
return (EINVAL);
}
fp->error = status;
mutex_enter(&fc_open_lock);
st->state = FC_STATE_ERROR_SET;
mutex_exit(&fc_open_lock);
return (0);
}