[mirror_qemu.git] / chardev / char-parallel.c

/*
 * QEMU System Emulator
 *
 * Copyright (c) 2003-2008 Fabrice Bellard
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */

#include "qemu/osdep.h"
#include "chardev/char.h"
#include "qapi/error.h"
#include "qemu/option.h"
#include <sys/ioctl.h>

#ifdef CONFIG_BSD
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
#include <dev/ppbus/ppi.h>
#include <dev/ppbus/ppbconf.h>
#elif defined(__DragonFly__)
#include <dev/misc/ppi/ppi.h>
#include <bus/ppbus/ppbconf.h>
#endif
#else
#ifdef __linux__
#include <linux/ppdev.h>
#include <linux/parport.h>
#endif
#endif

#include "chardev/char-fd.h"
#include "chardev/char-parallel.h"

#if defined(__linux__)

typedef struct {
    Chardev parent;
    int fd;
    int mode;
} ParallelChardev;

#define PARALLEL_CHARDEV(obj) \
    OBJECT_CHECK(ParallelChardev, (obj), TYPE_CHARDEV_PARALLEL)

static int pp_hw_mode(ParallelChardev *s, uint16_t mode)
{
    if (s->mode != mode) {
        int m = mode;
        if (ioctl(s->fd, PPSETMODE, &m) < 0) {
            return 0;
        }
        s->mode = mode;
    }
    return 1;
}

static int pp_ioctl(Chardev *chr, int cmd, void *arg)
{
    ParallelChardev *drv = PARALLEL_CHARDEV(chr);
    int fd = drv->fd;
    uint8_t b;

    switch (cmd) {
    case CHR_IOCTL_PP_READ_DATA:
        if (ioctl(fd, PPRDATA, &b) < 0) {
            return -ENOTSUP;
        }
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_WRITE_DATA:
        b = *(uint8_t *)arg;
        if (ioctl(fd, PPWDATA, &b) < 0) {
            return -ENOTSUP;
        }
        break;
    case CHR_IOCTL_PP_READ_CONTROL:
        if (ioctl(fd, PPRCONTROL, &b) < 0) {
            return -ENOTSUP;
        }
        /* Linux gives only the lowest bits, and no way to know data
           direction! For better compatibility set the fixed upper
           bits. */
        *(uint8_t *)arg = b | 0xc0;
        break;
    case CHR_IOCTL_PP_WRITE_CONTROL:
        b = *(uint8_t *)arg;
        if (ioctl(fd, PPWCONTROL, &b) < 0) {
            return -ENOTSUP;
        }
        break;
    case CHR_IOCTL_PP_READ_STATUS:
        if (ioctl(fd, PPRSTATUS, &b) < 0) {
            return -ENOTSUP;
        }
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_DATA_DIR:
        if (ioctl(fd, PPDATADIR, (int *)arg) < 0) {
            return -ENOTSUP;
        }
        break;
    case CHR_IOCTL_PP_EPP_READ_ADDR:
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP | IEEE1284_ADDR)) {
            struct ParallelIOArg *parg = arg;
            int n = read(fd, parg->buffer, parg->count);
            if (n != parg->count) {
                return -EIO;
            }
        }
        break;
    case CHR_IOCTL_PP_EPP_READ:
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
            struct ParallelIOArg *parg = arg;
            int n = read(fd, parg->buffer, parg->count);
            if (n != parg->count) {
                return -EIO;
            }
        }
        break;
    case CHR_IOCTL_PP_EPP_WRITE_ADDR:
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP | IEEE1284_ADDR)) {
            struct ParallelIOArg *parg = arg;
            int n = write(fd, parg->buffer, parg->count);
            if (n != parg->count) {
                return -EIO;
            }
        }
        break;
    case CHR_IOCTL_PP_EPP_WRITE:
        if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
            struct ParallelIOArg *parg = arg;
            int n = write(fd, parg->buffer, parg->count);
            if (n != parg->count) {
                return -EIO;
            }
        }
        break;
    default:
        return -ENOTSUP;
    }
    return 0;
}

static void qemu_chr_open_pp_fd(Chardev *chr,
                                int fd,
                                bool *be_opened,
                                Error **errp)
{
    ParallelChardev *drv = PARALLEL_CHARDEV(chr);

    if (ioctl(fd, PPCLAIM) < 0) {
        error_setg_errno(errp, errno, "not a parallel port");
        close(fd);
        return;
    }

    drv->fd = fd;
    drv->mode = IEEE1284_MODE_COMPAT;
}
#endif /* __linux__ */

#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || defined(__DragonFly__)

typedef struct {
    Chardev parent;
    int fd;
} ParallelChardev;

#define PARALLEL_CHARDEV(obj)                                   \
    OBJECT_CHECK(ParallelChardev, (obj), TYPE_CHARDEV_PARALLEL)

static int pp_ioctl(Chardev *chr, int cmd, void *arg)
{
    ParallelChardev *drv = PARALLEL_CHARDEV(chr);
    uint8_t b;

    switch (cmd) {
    case CHR_IOCTL_PP_READ_DATA:
        if (ioctl(drv->fd, PPIGDATA, &b) < 0) {
            return -ENOTSUP;
        }
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_WRITE_DATA:
        b = *(uint8_t *)arg;
        if (ioctl(drv->fd, PPISDATA, &b) < 0) {
            return -ENOTSUP;
        }
        break;
    case CHR_IOCTL_PP_READ_CONTROL:
        if (ioctl(drv->fd, PPIGCTRL, &b) < 0) {
            return -ENOTSUP;
        }
        *(uint8_t *)arg = b;
        break;
    case CHR_IOCTL_PP_WRITE_CONTROL:
        b = *(uint8_t *)arg;
        if (ioctl(drv->fd, PPISCTRL, &b) < 0) {
            return -ENOTSUP;
        }
        break;
    case CHR_IOCTL_PP_READ_STATUS:
        if (ioctl(drv->fd, PPIGSTATUS, &b) < 0) {
            return -ENOTSUP;
        }
        *(uint8_t *)arg = b;
        break;
    default:
        return -ENOTSUP;
    }
    return 0;
}

static void qemu_chr_open_pp_fd(Chardev *chr,
                                int fd,
                                bool *be_opened,
                                Error **errp)
{
    ParallelChardev *drv = PARALLEL_CHARDEV(chr);
    drv->fd = fd;
    *be_opened = false;
}
#endif

#ifdef HAVE_CHARDEV_PARPORT
static void qmp_chardev_open_parallel(Chardev *chr,
                                      ChardevBackend *backend,
                                      bool *be_opened,
                                      Error **errp)
{
    ChardevHostdev *parallel = backend->u.parallel.data;
    int fd;

    fd = qmp_chardev_open_file_source(parallel->device, O_RDWR, errp);
    if (fd < 0) {
        return;
    }
    qemu_chr_open_pp_fd(chr, fd, be_opened, errp);
}

static void qemu_chr_parse_parallel(QemuOpts *opts, ChardevBackend *backend,
                                    Error **errp)
{
    const char *device = qemu_opt_get(opts, "path");
    ChardevHostdev *parallel;

    if (device == NULL) {
        error_setg(errp, "chardev: parallel: no device path given");
        return;
    }
    backend->type = CHARDEV_BACKEND_KIND_PARALLEL;
    parallel = backend->u.parallel.data = g_new0(ChardevHostdev, 1);
    qemu_chr_parse_common(opts, qapi_ChardevHostdev_base(parallel));
    parallel->device = g_strdup(device);
}

static void char_parallel_class_init(ObjectClass *oc, void *data)
{
    ChardevClass *cc = CHARDEV_CLASS(oc);

    cc->parse = qemu_chr_parse_parallel;
    cc->open = qmp_chardev_open_parallel;
#if defined(__linux__)
    cc->chr_ioctl = pp_ioctl;
#elif defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || \
    defined(__DragonFly__)
    cc->chr_ioctl = pp_ioctl;
#endif
}

static void char_parallel_finalize(Object *obj)
{
#if defined(__linux__)
    Chardev *chr = CHARDEV(obj);
    ParallelChardev *drv = PARALLEL_CHARDEV(chr);
    int fd = drv->fd;

    pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
    ioctl(fd, PPRELEASE);
    close(fd);
    qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
#elif defined(__FreeBSD__) || defined(__FreeBSD_kernel__) || \
    defined(__DragonFly__)
    /* FIXME: close fd? */
#endif
}

static const TypeInfo char_parallel_type_info = {
    .name = TYPE_CHARDEV_PARALLEL,
    .parent = TYPE_CHARDEV,
    .instance_size = sizeof(ParallelChardev),
    .instance_finalize = char_parallel_finalize,
    .class_init = char_parallel_class_init,
};

static void register_types(void)
{
    type_register_static(&char_parallel_type_info);
}

type_init(register_types);

#endif
Commit	Line	Data
6aa0f0c9 MAL	1	/*
	2	* QEMU System Emulator
	3	*
	4	* Copyright (c) 2003-2008 Fabrice Bellard
	5	*
	6	* Permission is hereby granted, free of charge, to any person obtaining a copy
	7	* of this software and associated documentation files (the "Software"), to deal
	8	* in the Software without restriction, including without limitation the rights
	9	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
	10	* copies of the Software, and to permit persons to whom the Software is
	11	* furnished to do so, subject to the following conditions:
	12	*
	13	* The above copyright notice and this permission notice shall be included in
	14	* all copies or substantial portions of the Software.
	15	*
	16	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	17	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	18	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	19	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	20	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
	21	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
	22	* THE SOFTWARE.
	23	*/
922a01a0	24
6aa0f0c9	25	#include "qemu/osdep.h"
8228e353	26	#include "chardev/char.h"
6aa0f0c9	27	#include "qapi/error.h"
922a01a0	28	#include "qemu/option.h"
6aa0f0c9 MAL	29	#include <sys/ioctl.h>
	30
	31	#ifdef CONFIG_BSD
	32	#if defined(__FreeBSD__) \|\| defined(__FreeBSD_kernel__)
	33	#include <dev/ppbus/ppi.h>
	34	#include <dev/ppbus/ppbconf.h>
	35	#elif defined(__DragonFly__)
	36	#include <dev/misc/ppi/ppi.h>
	37	#include <bus/ppbus/ppbconf.h>
	38	#endif
	39	#else
	40	#ifdef __linux__
	41	#include <linux/ppdev.h>
	42	#include <linux/parport.h>
	43	#endif
	44	#endif
	45
8228e353 MAL	46	#include "chardev/char-fd.h"
8228e353 MAL	47	#include "chardev/char-parallel.h"
6aa0f0c9 MAL	48
	49	#if defined(__linux__)
	50
	51	typedef struct {
	52	Chardev parent;
	53	int fd;
	54	int mode;
	55	} ParallelChardev;
	56
	57	#define PARALLEL_CHARDEV(obj) \
	58	OBJECT_CHECK(ParallelChardev, (obj), TYPE_CHARDEV_PARALLEL)
	59
	60	static int pp_hw_mode(ParallelChardev *s, uint16_t mode)
	61	{
	62	if (s->mode != mode) {
	63	int m = mode;
	64	if (ioctl(s->fd, PPSETMODE, &m) < 0) {
	65	return 0;
	66	}
	67	s->mode = mode;
	68	}
	69	return 1;
	70	}
	71
	72	static int pp_ioctl(Chardev chr, int cmd, void arg)
	73	{
	74	ParallelChardev *drv = PARALLEL_CHARDEV(chr);
	75	int fd = drv->fd;
	76	uint8_t b;
	77
	78	switch (cmd) {
	79	case CHR_IOCTL_PP_READ_DATA:
	80	if (ioctl(fd, PPRDATA, &b) < 0) {
	81	return -ENOTSUP;
	82	}
	83	(uint8_t )arg = b;
	84	break;
	85	case CHR_IOCTL_PP_WRITE_DATA:
	86	b = (uint8_t )arg;
	87	if (ioctl(fd, PPWDATA, &b) < 0) {
	88	return -ENOTSUP;
	89	}
	90	break;
	91	case CHR_IOCTL_PP_READ_CONTROL:
	92	if (ioctl(fd, PPRCONTROL, &b) < 0) {
	93	return -ENOTSUP;
	94	}
	95	/* Linux gives only the lowest bits, and no way to know data
	96	direction! For better compatibility set the fixed upper
	97	bits. */
	98	(uint8_t )arg = b \| 0xc0;
	99	break;
	100	case CHR_IOCTL_PP_WRITE_CONTROL:
	101	b = (uint8_t )arg;
	102	if (ioctl(fd, PPWCONTROL, &b) < 0) {
	103	return -ENOTSUP;
	104	}
	105	break;
	106	case CHR_IOCTL_PP_READ_STATUS:
	107	if (ioctl(fd, PPRSTATUS, &b) < 0) {
	108	return -ENOTSUP;
	109	}
	110	(uint8_t )arg = b;
	111	break;
112	case CHR_IOCTL_PP_DATA_DIR:
113	if (ioctl(fd, PPDATADIR, (int *)arg) < 0) {
114	return -ENOTSUP;
115	}
116	break;
117	case CHR_IOCTL_PP_EPP_READ_ADDR:
118	if (pp_hw_mode(drv, IEEE1284_MODE_EPP \| IEEE1284_ADDR)) {
119	struct ParallelIOArg *parg = arg;
120	int n = read(fd, parg->buffer, parg->count);
121	if (n != parg->count) {
122	return -EIO;
123	}
124	}
125	break;
126	case CHR_IOCTL_PP_EPP_READ:
127	if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
128	struct ParallelIOArg *parg = arg;
129	int n = read(fd, parg->buffer, parg->count);
130	if (n != parg->count) {
131	return -EIO;
132	}
133	}
134	break;
135	case CHR_IOCTL_PP_EPP_WRITE_ADDR:
136	if (pp_hw_mode(drv, IEEE1284_MODE_EPP \| IEEE1284_ADDR)) {
137	struct ParallelIOArg *parg = arg;
138	int n = write(fd, parg->buffer, parg->count);
139	if (n != parg->count) {
140	return -EIO;
141	}
142	}
143	break;
144	case CHR_IOCTL_PP_EPP_WRITE:
145	if (pp_hw_mode(drv, IEEE1284_MODE_EPP)) {
146	struct ParallelIOArg *parg = arg;
147	int n = write(fd, parg->buffer, parg->count);
148	if (n != parg->count) {
149	return -EIO;
150	}
151	}
152	break;
153	default:
154	return -ENOTSUP;
155	}
156	return 0;
157	}
158
159	static void qemu_chr_open_pp_fd(Chardev *chr,
160	int fd,
161	bool *be_opened,
162	Error **errp)
163	{
164	ParallelChardev *drv = PARALLEL_CHARDEV(chr);
165
166	if (ioctl(fd, PPCLAIM) < 0) {
167	error_setg_errno(errp, errno, "not a parallel port");
168	close(fd);
169	return;
170	}
171
172	drv->fd = fd;
173	drv->mode = IEEE1284_MODE_COMPAT;
174	}
175	#endif /* __linux__ */
176
177	#if defined(__FreeBSD__) \|\| defined(__FreeBSD_kernel__) \|\| defined(__DragonFly__)
178
179	typedef struct {
180	Chardev parent;
181	int fd;
182	} ParallelChardev;
183
184	#define PARALLEL_CHARDEV(obj) \
185	OBJECT_CHECK(ParallelChardev, (obj), TYPE_CHARDEV_PARALLEL)
186
187	static int pp_ioctl(Chardev chr, int cmd, void arg)
188	{
189	ParallelChardev *drv = PARALLEL_CHARDEV(chr);
190	uint8_t b;
191
192	switch (cmd) {
193	case CHR_IOCTL_PP_READ_DATA:
194	if (ioctl(drv->fd, PPIGDATA, &b) < 0) {
195	return -ENOTSUP;
196	}
197	(uint8_t )arg = b;
198	break;
199	case CHR_IOCTL_PP_WRITE_DATA:
200	b = (uint8_t )arg;
201	if (ioctl(drv->fd, PPISDATA, &b) < 0) {
202	return -ENOTSUP;
203	}
204	break;
205	case CHR_IOCTL_PP_READ_CONTROL:
206	if (ioctl(drv->fd, PPIGCTRL, &b) < 0) {
207	return -ENOTSUP;
208	}
209	(uint8_t )arg = b;
210	break;
211	case CHR_IOCTL_PP_WRITE_CONTROL:
212	b = (uint8_t )arg;
213	if (ioctl(drv->fd, PPISCTRL, &b) < 0) {
214	return -ENOTSUP;
215	}
216	break;
217	case CHR_IOCTL_PP_READ_STATUS:
218	if (ioctl(drv->fd, PPIGSTATUS, &b) < 0) {
219	return -ENOTSUP;
220	}
221	(uint8_t )arg = b;
222	break;
223	default:
224	return -ENOTSUP;
225	}
226	return 0;
227	}
228
229	static void qemu_chr_open_pp_fd(Chardev *chr,
230	int fd,
231	bool *be_opened,
232	Error **errp)
233	{
234	ParallelChardev *drv = PARALLEL_CHARDEV(chr);
235	drv->fd = fd;
236	*be_opened = false;
237	}
238	#endif
239
240	#ifdef HAVE_CHARDEV_PARPORT
241	static void qmp_chardev_open_parallel(Chardev *chr,
242	ChardevBackend *backend,
243	bool *be_opened,
244	Error **errp)
245	{
246	ChardevHostdev *parallel = backend->u.parallel.data;
247	int fd;
248
249	fd = qmp_chardev_open_file_source(parallel->device, O_RDWR, errp);
250	if (fd < 0) {
251	return;
252	}
253	qemu_chr_open_pp_fd(chr, fd, be_opened, errp);
254	}
255
256	static void qemu_chr_parse_parallel(QemuOpts opts, ChardevBackend backend,
257	Error **errp)
258	{
259	const char *device = qemu_opt_get(opts, "path");
260	ChardevHostdev *parallel;
261
262	if (device == NULL) {
263	error_setg(errp, "chardev: parallel: no device path given");
264	return;
265	}
266	backend->type = CHARDEV_BACKEND_KIND_PARALLEL;
267	parallel = backend->u.parallel.data = g_new0(ChardevHostdev, 1);
268	qemu_chr_parse_common(opts, qapi_ChardevHostdev_base(parallel));
269	parallel->device = g_strdup(device);
270	}
271
272	static void char_parallel_class_init(ObjectClass oc, void data)
273	{
274	ChardevClass *cc = CHARDEV_CLASS(oc);
275
276	cc->parse = qemu_chr_parse_parallel;
277	cc->open = qmp_chardev_open_parallel;
278	#if defined(__linux__)
279	cc->chr_ioctl = pp_ioctl;
280	#elif defined(__FreeBSD__) \|\| defined(__FreeBSD_kernel__) \|\| \
281	defined(__DragonFly__)
282	cc->chr_ioctl = pp_ioctl;
283	#endif
284	}
285
286	static void char_parallel_finalize(Object *obj)
287	{
288	#if defined(__linux__)
289	Chardev *chr = CHARDEV(obj);
290	ParallelChardev *drv = PARALLEL_CHARDEV(chr);
291	int fd = drv->fd;
292
293	pp_hw_mode(drv, IEEE1284_MODE_COMPAT);
294	ioctl(fd, PPRELEASE);
295	close(fd);
296	qemu_chr_be_event(chr, CHR_EVENT_CLOSED);
297	#elif defined(__FreeBSD__) \|\| defined(__FreeBSD_kernel__) \|\| \
298	defined(__DragonFly__)
299	/* FIXME: close fd? */
300	#endif
301	}
302
303	static const TypeInfo char_parallel_type_info = {
304	.name = TYPE_CHARDEV_PARALLEL,
305	.parent = TYPE_CHARDEV,
306	.instance_size = sizeof(ParallelChardev),
307	.instance_finalize = char_parallel_finalize,
308	.class_init = char_parallel_class_init,
309	};
310
311	static void register_types(void)
312	{
313	type_register_static(&char_parallel_type_info);
314	}
315
316	type_init(register_types);
317
318	#endif