ni_daq_700.c revision eb14120f743d29744d9475bffec56ff4ad43a749
1/*
2 *     comedi/drivers/ni_daq_700.c
3 *     Driver for DAQCard-700 DIO only
4 *     copied from 8255
5 *
6 *     COMEDI - Linux Control and Measurement Device Interface
7 *     Copyright (C) 1998 David A. Schleef <ds@schleef.org>
8 *
9 *     This program is free software; you can redistribute it and/or modify
10 *     it under the terms of the GNU General Public License as published by
11 *     the Free Software Foundation; either version 2 of the License, or
12 *     (at your option) any later version.
13 *
14 *     This program is distributed in the hope that it will be useful,
15 *     but WITHOUT ANY WARRANTY; without even the implied warranty of
16 *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17 *     GNU General Public License for more details.
18 *
19 *     You should have received a copy of the GNU General Public License
20 *     along with this program; if not, write to the Free Software
21 *     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 *
23 */
24
25/*
26Driver: ni_daq_700
27Description: National Instruments PCMCIA DAQCard-700 DIO only
28Author: Fred Brooks <nsaspook@nsaspook.com>,
29  based on ni_daq_dio24 by Daniel Vecino Castel <dvecino@able.es>
30Devices: [National Instruments] PCMCIA DAQ-Card-700 (ni_daq_700)
31Status: works
32Updated: Thu, 21 Feb 2008 12:07:20 +0000
33
34The daqcard-700 appears in Comedi as a single digital I/O subdevice with
3516 channels.  The channel 0 corresponds to the daqcard-700's output
36port, bit 0; channel 8 corresponds to the input port, bit 0.
37
38Direction configuration: channels 0-7 output, 8-15 input (8225 device
39emu as port A output, port B input, port C N/A).
40
41IRQ is assigned but not used.
42*/
43
44#include <linux/interrupt.h>
45#include <linux/slab.h>
46#include "../comedidev.h"
47
48#include <linux/ioport.h>
49
50#include <pcmcia/cs_types.h>
51#include <pcmcia/cs.h>
52#include <pcmcia/cistpl.h>
53#include <pcmcia/cisreg.h>
54#include <pcmcia/ds.h>
55
56static struct pcmcia_device *pcmcia_cur_dev = NULL;
57
58#define DIO700_SIZE 8		/*  size of io region used by board */
59
60static int dio700_attach(struct comedi_device *dev,
61			 struct comedi_devconfig *it);
62static int dio700_detach(struct comedi_device *dev);
63
64enum dio700_bustype { pcmcia_bustype };
65
66struct dio700_board {
67	const char *name;
68	int device_id;		/*  device id for pcmcia board */
69	enum dio700_bustype bustype;	/*  PCMCIA */
70	int have_dio;		/*  have daqcard-700 dio */
71	/*  function pointers so we can use inb/outb or readb/writeb */
72	/*  as appropriate */
73	unsigned int (*read_byte) (unsigned int address);
74	void (*write_byte) (unsigned int byte, unsigned int address);
75};
76
77static const struct dio700_board dio700_boards[] = {
78	{
79	 .name = "daqcard-700",
80	  /*  0x10b is manufacturer id, 0x4743 is device id */
81	 .device_id = 0x4743,
82	 .bustype = pcmcia_bustype,
83	 .have_dio = 1,
84	 },
85	{
86	 .name = "ni_daq_700",
87	  /*  0x10b is manufacturer id, 0x4743 is device id */
88	 .device_id = 0x4743,
89	 .bustype = pcmcia_bustype,
90	 .have_dio = 1,
91	 },
92};
93
94/*
95 * Useful for shorthand access to the particular board structure
96 */
97#define thisboard ((const struct dio700_board *)dev->board_ptr)
98
99struct dio700_private {
100
101	int data;		/* number of data points left to be taken */
102};
103
104#define devpriv ((struct dio700_private *)dev->private)
105
106static struct comedi_driver driver_dio700 = {
107	.driver_name = "ni_daq_700",
108	.module = THIS_MODULE,
109	.attach = dio700_attach,
110	.detach = dio700_detach,
111	.num_names = ARRAY_SIZE(dio700_boards),
112	.board_name = &dio700_boards[0].name,
113	.offset = sizeof(struct dio700_board),
114};
115
116/*	the real driver routines	*/
117
118#define _700_SIZE 8
119
120#define _700_DATA 0
121
122#define DIO_W		0x04
123#define DIO_R		0x05
124
125struct subdev_700_struct {
126	unsigned long cb_arg;
127	int (*cb_func) (int, int, int, unsigned long);
128	int have_irq;
129};
130
131#define CALLBACK_ARG	(((struct subdev_700_struct *)s->private)->cb_arg)
132#define CALLBACK_FUNC	(((struct subdev_700_struct *)s->private)->cb_func)
133#define subdevpriv	((struct subdev_700_struct *)s->private)
134
135static void do_config(struct comedi_device *dev, struct comedi_subdevice *s);
136
137void subdev_700_interrupt(struct comedi_device *dev, struct comedi_subdevice *s)
138{
139	short d;
140
141	d = CALLBACK_FUNC(0, _700_DATA, 0, CALLBACK_ARG);
142
143	comedi_buf_put(s->async, d);
144	s->async->events |= COMEDI_CB_EOS;
145
146	comedi_event(dev, s);
147}
148
149static int subdev_700_cb(int dir, int port, int data, unsigned long arg)
150{
151	/* port is always A for output and B for input (8255 emu) */
152	unsigned long iobase = arg;
153
154	if (dir) {
155		outb(data, iobase + DIO_W);
156		return 0;
157	} else {
158		return inb(iobase + DIO_R);
159	}
160}
161
162static int subdev_700_insn(struct comedi_device *dev,
163			   struct comedi_subdevice *s, struct comedi_insn *insn,
164			   unsigned int *data)
165{
166	if (data[0]) {
167		s->state &= ~data[0];
168		s->state |= (data[0] & data[1]);
169
170		if (data[0] & 0xff)
171			CALLBACK_FUNC(1, _700_DATA, s->state & 0xff,
172				      CALLBACK_ARG);
173	}
174
175	data[1] = s->state & 0xff;
176	data[1] |= CALLBACK_FUNC(0, _700_DATA, 0, CALLBACK_ARG) << 8;
177
178	return 2;
179}
180
181static int subdev_700_insn_config(struct comedi_device *dev,
182				  struct comedi_subdevice *s,
183				  struct comedi_insn *insn, unsigned int *data)
184{
185
186	switch (data[0]) {
187	case INSN_CONFIG_DIO_INPUT:
188		break;
189	case INSN_CONFIG_DIO_OUTPUT:
190		break;
191	case INSN_CONFIG_DIO_QUERY:
192		data[1] =
193		    (s->
194		     io_bits & (1 << CR_CHAN(insn->chanspec))) ? COMEDI_OUTPUT :
195		    COMEDI_INPUT;
196		return insn->n;
197		break;
198	default:
199		return -EINVAL;
200	}
201
202	return 1;
203}
204
205static void do_config(struct comedi_device *dev, struct comedi_subdevice *s)
206{				/* use powerup defaults */
207	return;
208}
209
210static int subdev_700_cmdtest(struct comedi_device *dev,
211			      struct comedi_subdevice *s,
212			      struct comedi_cmd *cmd)
213{
214	int err = 0;
215	unsigned int tmp;
216
217	/* step 1 */
218
219	tmp = cmd->start_src;
220	cmd->start_src &= TRIG_NOW;
221	if (!cmd->start_src || tmp != cmd->start_src)
222		err++;
223
224	tmp = cmd->scan_begin_src;
225	cmd->scan_begin_src &= TRIG_EXT;
226	if (!cmd->scan_begin_src || tmp != cmd->scan_begin_src)
227		err++;
228
229	tmp = cmd->convert_src;
230	cmd->convert_src &= TRIG_FOLLOW;
231	if (!cmd->convert_src || tmp != cmd->convert_src)
232		err++;
233
234	tmp = cmd->scan_end_src;
235	cmd->scan_end_src &= TRIG_COUNT;
236	if (!cmd->scan_end_src || tmp != cmd->scan_end_src)
237		err++;
238
239	tmp = cmd->stop_src;
240	cmd->stop_src &= TRIG_NONE;
241	if (!cmd->stop_src || tmp != cmd->stop_src)
242		err++;
243
244	if (err)
245		return 1;
246
247	/* step 2 */
248
249	if (err)
250		return 2;
251
252	/* step 3 */
253
254	if (cmd->start_arg != 0) {
255		cmd->start_arg = 0;
256		err++;
257	}
258	if (cmd->scan_begin_arg != 0) {
259		cmd->scan_begin_arg = 0;
260		err++;
261	}
262	if (cmd->convert_arg != 0) {
263		cmd->convert_arg = 0;
264		err++;
265	}
266	if (cmd->scan_end_arg != 1) {
267		cmd->scan_end_arg = 1;
268		err++;
269	}
270	if (cmd->stop_arg != 0) {
271		cmd->stop_arg = 0;
272		err++;
273	}
274
275	if (err)
276		return 3;
277
278	/* step 4 */
279
280	if (err)
281		return 4;
282
283	return 0;
284}
285
286static int subdev_700_cmd(struct comedi_device *dev, struct comedi_subdevice *s)
287{
288	/* FIXME */
289
290	return 0;
291}
292
293static int subdev_700_cancel(struct comedi_device *dev,
294			     struct comedi_subdevice *s)
295{
296	/* FIXME */
297
298	return 0;
299}
300
301int subdev_700_init(struct comedi_device *dev, struct comedi_subdevice *s,
302		    int (*cb) (int, int, int, unsigned long), unsigned long arg)
303{
304	s->type = COMEDI_SUBD_DIO;
305	s->subdev_flags = SDF_READABLE | SDF_WRITABLE;
306	s->n_chan = 16;
307	s->range_table = &range_digital;
308	s->maxdata = 1;
309
310	s->private = kmalloc(sizeof(struct subdev_700_struct), GFP_KERNEL);
311	if (!s->private)
312		return -ENOMEM;
313
314	CALLBACK_ARG = arg;
315	if (cb == NULL)
316		CALLBACK_FUNC = subdev_700_cb;
317	 else
318		CALLBACK_FUNC = cb;
319
320	s->insn_bits = subdev_700_insn;
321	s->insn_config = subdev_700_insn_config;
322
323	s->state = 0;
324	s->io_bits = 0x00ff;
325	do_config(dev, s);
326
327	return 0;
328}
329
330int subdev_700_init_irq(struct comedi_device *dev, struct comedi_subdevice *s,
331			int (*cb) (int, int, int, unsigned long),
332			unsigned long arg)
333{
334	int ret;
335
336	ret = subdev_700_init(dev, s, cb, arg);
337	if (ret < 0)
338		return ret;
339
340	s->do_cmdtest = subdev_700_cmdtest;
341	s->do_cmd = subdev_700_cmd;
342	s->cancel = subdev_700_cancel;
343
344	subdevpriv->have_irq = 1;
345
346	return 0;
347}
348
349void subdev_700_cleanup(struct comedi_device *dev, struct comedi_subdevice *s)
350{
351	if (s->private)
352		if (subdevpriv->have_irq)
353
354			kfree(s->private);
355}
356
357EXPORT_SYMBOL(subdev_700_init);
358EXPORT_SYMBOL(subdev_700_init_irq);
359EXPORT_SYMBOL(subdev_700_cleanup);
360EXPORT_SYMBOL(subdev_700_interrupt);
361
362static int dio700_attach(struct comedi_device *dev, struct comedi_devconfig *it)
363{
364	struct comedi_subdevice *s;
365	unsigned long iobase = 0;
366#ifdef incomplete
367	unsigned int irq = 0;
368#endif
369	struct pcmcia_device *link;
370
371	/* allocate and initialize dev->private */
372	if (alloc_private(dev, sizeof(struct dio700_private)) < 0)
373		return -ENOMEM;
374
375	/*  get base address, irq etc. based on bustype */
376	switch (thisboard->bustype) {
377	case pcmcia_bustype:
378		link = pcmcia_cur_dev;	/* XXX hack */
379		if (!link)
380			return -EIO;
381		iobase = link->io.BasePort1;
382#ifdef incomplete
383		irq = link->irq;
384#endif
385		break;
386	default:
387		printk("bug! couldn't determine board type\n");
388		return -EINVAL;
389		break;
390	}
391	printk("comedi%d: ni_daq_700: %s, io 0x%lx", dev->minor,
392	       thisboard->name, iobase);
393#ifdef incomplete
394	if (irq)
395		printk(", irq %u", irq);
396
397#endif
398
399	printk("\n");
400
401	if (iobase == 0) {
402		printk("io base address is zero!\n");
403		return -EINVAL;
404	}
405
406	dev->iobase = iobase;
407
408#ifdef incomplete
409	/* grab our IRQ */
410	dev->irq = irq;
411#endif
412
413	dev->board_name = thisboard->name;
414
415	if (alloc_subdevices(dev, 1) < 0)
416		return -ENOMEM;
417
418	/* DAQCard-700 dio */
419	s = dev->subdevices + 0;
420	subdev_700_init(dev, s, NULL, dev->iobase);
421
422	return 0;
423};
424
425static int dio700_detach(struct comedi_device *dev)
426{
427	printk("comedi%d: ni_daq_700: cs-remove\n", dev->minor);
428
429	if (dev->subdevices)
430		subdev_700_cleanup(dev, dev->subdevices + 0);
431
432	if (thisboard->bustype != pcmcia_bustype && dev->iobase)
433		release_region(dev->iobase, DIO700_SIZE);
434	if (dev->irq)
435		free_irq(dev->irq, dev);
436
437	return 0;
438};
439
440/* PCMCIA crap -- watch your words, please! */
441
442static void dio700_config(struct pcmcia_device *link);
443static void dio700_release(struct pcmcia_device *link);
444static int dio700_cs_suspend(struct pcmcia_device *p_dev);
445static int dio700_cs_resume(struct pcmcia_device *p_dev);
446
447/*
448   The attach() and detach() entry points are used to create and destroy
449   "instances" of the driver, where each instance represents everything
450   needed to manage one actual PCMCIA card.
451*/
452
453static int dio700_cs_attach(struct pcmcia_device *);
454static void dio700_cs_detach(struct pcmcia_device *);
455
456/*
457   You'll also need to prototype all the functions that will actually
458   be used to talk to your device.  See 'memory_cs' for a good example
459   of a fully self-sufficient driver; the other drivers rely more or
460   less on other parts of the kernel.
461*/
462
463/*
464   The dev_info variable is the "key" that is used to match up this
465   device driver with appropriate cards, through the card configuration
466   database.
467*/
468
469static const dev_info_t dev_info = "ni_daq_700";
470
471struct local_info_t {
472	struct pcmcia_device *link;
473	dev_node_t node;
474	int stop;
475	struct bus_operations *bus;
476};
477
478/*======================================================================
479
480    dio700_cs_attach() creates an "instance" of the driver, allocating
481    local data structures for one device.  The device is registered
482    with Card Services.
483
484    The dev_link structure is initialized, but we don't actually
485    configure the card at this point -- we wait until we receive a
486    card insertion event.
487
488======================================================================*/
489
490static int dio700_cs_attach(struct pcmcia_device *link)
491{
492	struct local_info_t *local;
493
494	printk(KERN_INFO "ni_daq_700:  cs-attach\n");
495
496	dev_dbg(&link->dev, "dio700_cs_attach()\n");
497
498	/* Allocate space for private device-specific data */
499	local = kzalloc(sizeof(struct local_info_t), GFP_KERNEL);
500	if (!local)
501		return -ENOMEM;
502	local->link = link;
503	link->priv = local;
504
505	/*
506	   General socket configuration defaults can go here.  In this
507	   client, we assume very little, and rely on the CIS for almost
508	   everything.  In most clients, many details (i.e., number, sizes,
509	   and attributes of IO windows) are fixed by the nature of the
510	   device, and can be hard-wired here.
511	 */
512	link->conf.Attributes = 0;
513	link->conf.IntType = INT_MEMORY_AND_IO;
514
515	pcmcia_cur_dev = link;
516
517	dio700_config(link);
518
519	return 0;
520}				/* dio700_cs_attach */
521
522/*======================================================================
523
524    This deletes a driver "instance".  The device is de-registered
525    with Card Services.  If it has been released, all local data
526    structures are freed.  Otherwise, the structures will be freed
527    when the device is released.
528
529======================================================================*/
530
531static void dio700_cs_detach(struct pcmcia_device *link)
532{
533
534	printk(KERN_INFO "ni_daq_700: cs-detach!\n");
535
536	dev_dbg(&link->dev, "dio700_cs_detach\n");
537
538	if (link->dev_node) {
539		((struct local_info_t *)link->priv)->stop = 1;
540		dio700_release(link);
541	}
542
543	/* This points to the parent struct local_info_t struct */
544	if (link->priv)
545		kfree(link->priv);
546
547}				/* dio700_cs_detach */
548
549/*======================================================================
550
551    dio700_config() is scheduled to run after a CARD_INSERTION event
552    is received, to configure the PCMCIA socket, and to make the
553    device available to the system.
554
555======================================================================*/
556
557static int dio700_pcmcia_config_loop(struct pcmcia_device *p_dev,
558				cistpl_cftable_entry_t *cfg,
559				cistpl_cftable_entry_t *dflt,
560				unsigned int vcc,
561				void *priv_data)
562{
563	win_req_t *req = priv_data;
564	memreq_t map;
565
566	if (cfg->index == 0)
567		return -ENODEV;
568
569	/* Does this card need audio output? */
570	if (cfg->flags & CISTPL_CFTABLE_AUDIO) {
571		p_dev->conf.Attributes |= CONF_ENABLE_SPKR;
572		p_dev->conf.Status = CCSR_AUDIO_ENA;
573	}
574
575	/* Do we need to allocate an interrupt? */
576	p_dev->conf.Attributes |= CONF_ENABLE_IRQ;
577
578	/* IO window settings */
579	p_dev->io.NumPorts1 = p_dev->io.NumPorts2 = 0;
580	if ((cfg->io.nwin > 0) || (dflt->io.nwin > 0)) {
581		cistpl_io_t *io = (cfg->io.nwin) ? &cfg->io : &dflt->io;
582		p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_AUTO;
583		if (!(io->flags & CISTPL_IO_8BIT))
584			p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_16;
585		if (!(io->flags & CISTPL_IO_16BIT))
586			p_dev->io.Attributes1 = IO_DATA_PATH_WIDTH_8;
587		p_dev->io.IOAddrLines = io->flags & CISTPL_IO_LINES_MASK;
588		p_dev->io.BasePort1 = io->win[0].base;
589		p_dev->io.NumPorts1 = io->win[0].len;
590		if (io->nwin > 1) {
591			p_dev->io.Attributes2 = p_dev->io.Attributes1;
592			p_dev->io.BasePort2 = io->win[1].base;
593			p_dev->io.NumPorts2 = io->win[1].len;
594		}
595		/* This reserves IO space but doesn't actually enable it */
596		if (pcmcia_request_io(p_dev, &p_dev->io) != 0)
597			return -ENODEV;
598	}
599
600	if ((cfg->mem.nwin > 0) || (dflt->mem.nwin > 0)) {
601		cistpl_mem_t *mem =
602			(cfg->mem.nwin) ? &cfg->mem : &dflt->mem;
603		req->Attributes = WIN_DATA_WIDTH_16 | WIN_MEMORY_TYPE_CM;
604		req->Attributes |= WIN_ENABLE;
605		req->Base = mem->win[0].host_addr;
606		req->Size = mem->win[0].len;
607		if (req->Size < 0x1000)
608			req->Size = 0x1000;
609		req->AccessSpeed = 0;
610		if (pcmcia_request_window(p_dev, req, &p_dev->win))
611			return -ENODEV;
612		map.Page = 0;
613		map.CardOffset = mem->win[0].card_addr;
614		if (pcmcia_map_mem_page(p_dev, p_dev->win, &map))
615			return -ENODEV;
616	}
617	/* If we got this far, we're cool! */
618	return 0;
619}
620
621static void dio700_config(struct pcmcia_device *link)
622{
623	struct local_info_t *dev = link->priv;
624	win_req_t req;
625	int ret;
626
627	printk(KERN_INFO "ni_daq_700:  cs-config\n");
628
629	dev_dbg(&link->dev, "dio700_config\n");
630
631	ret = pcmcia_loop_config(link, dio700_pcmcia_config_loop, &req);
632	if (ret) {
633		dev_warn(&link->dev, "no configuration found\n");
634		goto failed;
635	}
636
637	if (!link->irq)
638		goto failed;
639
640	/*
641	   This actually configures the PCMCIA socket -- setting up
642	   the I/O windows and the interrupt mapping, and putting the
643	   card and host interface into "Memory and IO" mode.
644	 */
645	ret = pcmcia_request_configuration(link, &link->conf);
646	if (ret != 0)
647		goto failed;
648
649	/*
650	   At this point, the dev_node_t structure(s) need to be
651	   initialized and arranged in a linked list at link->dev.
652	 */
653	sprintf(dev->node.dev_name, "ni_daq_700");
654	dev->node.major = dev->node.minor = 0;
655	link->dev_node = &dev->node;
656
657	/* Finally, report what we've done */
658	printk(KERN_INFO "%s: index 0x%02x",
659	       dev->node.dev_name, link->conf.ConfigIndex);
660	if (link->conf.Attributes & CONF_ENABLE_IRQ)
661		printk(", irq %d", link->irq);
662	if (link->io.NumPorts1)
663		printk(", io 0x%04x-0x%04x", link->io.BasePort1,
664		       link->io.BasePort1 + link->io.NumPorts1 - 1);
665	if (link->io.NumPorts2)
666		printk(" & 0x%04x-0x%04x", link->io.BasePort2,
667		       link->io.BasePort2 + link->io.NumPorts2 - 1);
668	if (link->win)
669		printk(", mem 0x%06lx-0x%06lx", req.Base,
670		       req.Base + req.Size - 1);
671	printk("\n");
672
673	return;
674
675failed:
676	printk(KERN_INFO "ni_daq_700 cs failed");
677	dio700_release(link);
678
679}				/* dio700_config */
680
681static void dio700_release(struct pcmcia_device *link)
682{
683	dev_dbg(&link->dev, "dio700_release\n");
684
685	pcmcia_disable_device(link);
686}				/* dio700_release */
687
688/*======================================================================
689
690    The card status event handler.  Mostly, this schedules other
691    stuff to run after an event is received.
692
693    When a CARD_REMOVAL event is received, we immediately set a
694    private flag to block future accesses to this device.  All the
695    functions that actually access the device should check this flag
696    to make sure the card is still present.
697
698======================================================================*/
699
700static int dio700_cs_suspend(struct pcmcia_device *link)
701{
702	struct local_info_t *local = link->priv;
703
704	/* Mark the device as stopped, to block IO until later */
705	local->stop = 1;
706	return 0;
707}				/* dio700_cs_suspend */
708
709static int dio700_cs_resume(struct pcmcia_device *link)
710{
711	struct local_info_t *local = link->priv;
712
713	local->stop = 0;
714	return 0;
715}				/* dio700_cs_resume */
716
717/*====================================================================*/
718
719static struct pcmcia_device_id dio700_cs_ids[] = {
720	/* N.B. These IDs should match those in dio700_boards */
721	PCMCIA_DEVICE_MANF_CARD(0x010b, 0x4743),	/* daqcard-700 */
722	PCMCIA_DEVICE_NULL
723};
724
725MODULE_LICENSE("GPL");
726MODULE_DEVICE_TABLE(pcmcia, dio700_cs_ids);
727
728struct pcmcia_driver dio700_cs_driver = {
729	.probe = dio700_cs_attach,
730	.remove = dio700_cs_detach,
731	.suspend = dio700_cs_suspend,
732	.resume = dio700_cs_resume,
733	.id_table = dio700_cs_ids,
734	.owner = THIS_MODULE,
735	.drv = {
736		.name = dev_info,
737		},
738};
739
740static int __init init_dio700_cs(void)
741{
742	pcmcia_register_driver(&dio700_cs_driver);
743	return 0;
744}
745
746static void __exit exit_dio700_cs(void)
747{
748	pr_debug("ni_daq_700: unloading\n");
749	pcmcia_unregister_driver(&dio700_cs_driver);
750}
751
752int __init init_module(void)
753{
754	int ret;
755
756	ret = init_dio700_cs();
757	if (ret < 0)
758		return ret;
759
760	return comedi_driver_register(&driver_dio700);
761}
762
763void __exit cleanup_module(void)
764{
765	exit_dio700_cs();
766	comedi_driver_unregister(&driver_dio700);
767}
768