217 lines
5.0 KiB
C
217 lines
5.0 KiB
C
/*-
|
|
* SPDX-License-Identifier: BSD-2-Clause
|
|
*
|
|
* Copyright (c) 2004 Mark R V Murray
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions and the following disclaimer
|
|
* in this position and unchanged.
|
|
* 2. Redistributions in binary form must reproduce the above copyright
|
|
* notice, this list of conditions and the following disclaimer in the
|
|
* documentation and/or other materials provided with the distribution.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHORS ``AS IS'' AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
|
|
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
|
|
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
|
|
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
|
|
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
|
|
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
|
|
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
|
|
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
*
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
#include <sys/param.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/ioccom.h>
|
|
#include <sys/module.h>
|
|
#include <sys/priv.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/systm.h>
|
|
|
|
#include <machine/iodev.h>
|
|
|
|
#include <dev/io/iodev.h>
|
|
|
|
static int ioopen(struct cdev *dev, int flags, int fmt,
|
|
struct thread *td);
|
|
static int ioclose(struct cdev *dev, int flags, int fmt,
|
|
struct thread *td);
|
|
static int ioioctl(struct cdev *dev, u_long cmd, caddr_t data,
|
|
int fflag, struct thread *td);
|
|
|
|
static int iopio_read(struct iodev_pio_req *req);
|
|
static int iopio_write(struct iodev_pio_req *req);
|
|
|
|
static struct cdev *iodev;
|
|
|
|
static struct cdevsw io_cdevsw = {
|
|
.d_version = D_VERSION,
|
|
.d_open = ioopen,
|
|
.d_close = ioclose,
|
|
.d_ioctl = ioioctl,
|
|
.d_name = "io",
|
|
};
|
|
|
|
/* ARGSUSED */
|
|
static int
|
|
ioopen(struct cdev *dev __unused, int flags __unused, int fmt __unused,
|
|
struct thread *td)
|
|
{
|
|
int error;
|
|
|
|
error = priv_check(td, PRIV_IO);
|
|
if (error != 0)
|
|
return (error);
|
|
error = securelevel_gt(td->td_ucred, 0);
|
|
if (error != 0)
|
|
return (error);
|
|
error = iodev_open(td);
|
|
|
|
return (error);
|
|
}
|
|
|
|
/* ARGSUSED */
|
|
static int
|
|
ioclose(struct cdev *dev __unused, int flags __unused, int fmt __unused,
|
|
struct thread *td)
|
|
{
|
|
|
|
return (iodev_close(td));
|
|
}
|
|
|
|
/* ARGSUSED */
|
|
static int
|
|
ioioctl(struct cdev *dev __unused, u_long cmd, caddr_t data,
|
|
int fflag __unused, struct thread *td __unused)
|
|
{
|
|
struct iodev_pio_req *pio_req;
|
|
int error;
|
|
|
|
switch (cmd) {
|
|
case IODEV_PIO:
|
|
pio_req = (struct iodev_pio_req *)data;
|
|
switch (pio_req->access) {
|
|
case IODEV_PIO_READ:
|
|
error = iopio_read(pio_req);
|
|
break;
|
|
case IODEV_PIO_WRITE:
|
|
error = iopio_write(pio_req);
|
|
break;
|
|
default:
|
|
error = EINVAL;
|
|
break;
|
|
}
|
|
break;
|
|
default:
|
|
error = iodev_ioctl(cmd, data);
|
|
}
|
|
|
|
return (error);
|
|
}
|
|
|
|
static int
|
|
iopio_read(struct iodev_pio_req *req)
|
|
{
|
|
|
|
switch (req->width) {
|
|
case 1:
|
|
req->val = iodev_read_1(req->port);
|
|
break;
|
|
case 2:
|
|
if (req->port & 1) {
|
|
req->val = iodev_read_1(req->port);
|
|
req->val |= iodev_read_1(req->port + 1) << 8;
|
|
} else
|
|
req->val = iodev_read_2(req->port);
|
|
break;
|
|
case 4:
|
|
if (req->port & 1) {
|
|
req->val = iodev_read_1(req->port);
|
|
req->val |= iodev_read_2(req->port + 1) << 8;
|
|
req->val |= iodev_read_1(req->port + 3) << 24;
|
|
} else if (req->port & 2) {
|
|
req->val = iodev_read_2(req->port);
|
|
req->val |= iodev_read_2(req->port + 2) << 16;
|
|
} else
|
|
req->val = iodev_read_4(req->port);
|
|
break;
|
|
default:
|
|
return (EINVAL);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
static int
|
|
iopio_write(struct iodev_pio_req *req)
|
|
{
|
|
|
|
switch (req->width) {
|
|
case 1:
|
|
iodev_write_1(req->port, req->val);
|
|
break;
|
|
case 2:
|
|
if (req->port & 1) {
|
|
iodev_write_1(req->port, req->val);
|
|
iodev_write_1(req->port + 1, req->val >> 8);
|
|
} else
|
|
iodev_write_2(req->port, req->val);
|
|
break;
|
|
case 4:
|
|
if (req->port & 1) {
|
|
iodev_write_1(req->port, req->val);
|
|
iodev_write_2(req->port + 1, req->val >> 8);
|
|
iodev_write_1(req->port + 3, req->val >> 24);
|
|
} else if (req->port & 2) {
|
|
iodev_write_2(req->port, req->val);
|
|
iodev_write_2(req->port + 2, req->val >> 16);
|
|
} else
|
|
iodev_write_4(req->port, req->val);
|
|
break;
|
|
default:
|
|
return (EINVAL);
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
/* ARGSUSED */
|
|
static int
|
|
io_modevent(module_t mod __unused, int type, void *data __unused)
|
|
{
|
|
switch(type) {
|
|
case MOD_LOAD:
|
|
if (bootverbose)
|
|
printf("io: <I/O>\n");
|
|
iodev = make_dev(&io_cdevsw, 0,
|
|
UID_ROOT, GID_WHEEL, 0600, "io");
|
|
break;
|
|
|
|
case MOD_UNLOAD:
|
|
destroy_dev(iodev);
|
|
break;
|
|
|
|
case MOD_SHUTDOWN:
|
|
break;
|
|
|
|
default:
|
|
return(EOPNOTSUPP);
|
|
break;
|
|
|
|
}
|
|
|
|
return (0);
|
|
}
|
|
|
|
DEV_MODULE(io, io_modevent, NULL);
|
|
MODULE_VERSION(io, 1);
|