vordog: vordog.c annotate

annotate vordog.c @ 5:e59963b503cb

Remove tedious messages.

author	Thinker K.F. Li <thinker@branda.to>
date	Tue, 08 Jul 2008 12:31:29 +0800
parents	60a234c9c03f
children	76ce6e6624b8

rev	line source
3 60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	1 /*-
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	2 * Copyright (c) 2008 Kueifong Li <thinker@branda.to>.
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	3 * All rights reserved.
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	4 *
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	5 * Redistribution and use in source and binary forms, with or without
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	6 * modification, are permitted provided that the following conditions
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	7 * are met:
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	8 * 1. Redistributions of source code must retain the above copyright
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	9 * notice, this list of conditions and the following disclaimer.
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	10 * 2. Redistributions in binary form must reproduce the above copyright
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	11 * notice, this list of conditions and the following disclaimer in the
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	12 * documentation and/or other materials provided with the distribution.
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	13 *
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	14 * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	15 * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	16 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	17 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	18 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	19 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	20 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	21 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	22 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	23 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	24 * POSSIBILITY OF SUCH DAMAGE.
60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	25 */
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	26 #include <sys/param.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	27 #include <sys/bus.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	28 #include <sys/conf.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	29 #include <sys/kernel.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	30 #include <sys/module.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	31 #include <sys/systm.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	32 #include <sys/proc.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	33 #include <sys/ioccom.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	34 #include <sys/types.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	35 #include <sys/malloc.h>
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	36 #include "vordog.h"
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	37
3 60a234c9c03f Add 2-clause BSD license Thinker K.F. Li <thinker@branda.to> parents: 1 diff changeset	38 #if 0
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	39 #undef __FreeBSD_version
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	40 #define __FreeBSD_version 800029
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	41 #endif
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	42
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	43 #define VD_STATUS 0x841
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	44 #define VD_INITVAL 0x84a
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	45 #define VD_CTR 0x84b
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	46
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	47 typedef struct vd_softc {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	48 struct cdev *_cdev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	49 device_t dev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	50 int open_cnt;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	51 int init_val;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	52 } *vd_softc_t;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	53
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	54 #define CDEV_2_SOFTC(_cdev) ((_cdev)->si_drv1)
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	55
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	56 static int
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	57 vordog_open(struct cdev dev, int oflags, int devtype, struct thread td) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	58 vd_softc_t sc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	59
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	60 sc = CDEV_2_SOFTC(dev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	61 sc->open_cnt++;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	62
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	63 return 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	64 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	65
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	66 static int
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	67 vordog_close(struct cdev dev, int fflag, int devtype, struct thread td) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	68 vd_softc_t sc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	69
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	70 sc = CDEV_2_SOFTC(dev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	71 sc->open_cnt--;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	72
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	73 return 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	74 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	75
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	76 static int
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	77 vordog_go_detach(void) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	78 devclass_t vd_dc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	79 device_t vd_dev, nexus_dev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	80 int r;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	81
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	82 vd_dc = devclass_find("vordog");
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	83 if(vd_dc == NULL)
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	84 return EINVAL;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	85
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	86 vd_dev = devclass_get_device(vd_dc, 0);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	87 if(vd_dev == NULL)
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	88 return EINVAL;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	89
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	90 nexus_dev = device_get_parent(vd_dev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	91 if(nexus_dev == NULL)
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	92 return EINVAL;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	93
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	94 r = device_delete_child(nexus_dev, vd_dev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	95 return r;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	96 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	97
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	98 static void
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	99 setup_timer(vordog_cfg_t cfg) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	100 int val;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	101 #define VD_TIMER_RST 0xc
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	102
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	103 val = cfg->init_val & 0xff;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	104 outb(VD_INITVAL, val);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	105 val = 0x80 \| ((cfg->unit & 0x3) << 4) \| VD_TIMER_RST;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	106 outb(VD_CTR, val);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	107 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	108
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	109 static void
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	110 reset_timer(int init_val) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	111 outb(VD_STATUS, 0xc0);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	112 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	113
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	114 static void
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	115 disable_timer(void) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	116 outb(VD_CTR, 0);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	117 outb(VD_STATUS, 0xc0);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	118 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	119
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	120 static int
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	121 vordog_ioctl(struct cdev *dev, u_long cmd, caddr_t data,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	122 int fflag, struct thread *td) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	123 int r = 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	124 vd_softc_t sc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	125 vordog_cfg_t cfg;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	126
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	127 sc = CDEV_2_SOFTC(dev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	128 switch(cmd) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	129 case VDCTL_ENABLE:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	130 cfg = (vordog_cfg_t)data;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	131 sc->init_val = cfg->init_val & 0xff;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	132 setup_timer(cfg);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	133 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	134 case VDCTL_RESET:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	135 reset_timer(sc->init_val);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	136 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	137 case VDCTL_DISABLE:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	138 disable_timer();
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	139 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	140 default:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	141 r = EINVAL;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	142 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	143 return r;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	144 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	145
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	146 struct cdevsw vordog_cdevsw = {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	147 .d_version = D_VERSION,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	148 .d_open = vordog_open,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	149 .d_close = vordog_close,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	150 .d_ioctl = vordog_ioctl,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	151 .d_name = "vordog",
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	152 };
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	153
5 e59963b503cb Remove tedious messages. Thinker K.F. Li <thinker@branda.to> parents: 3 diff changeset	154 /* Following implements a new bus device.
e59963b503cb Remove tedious messages. Thinker K.F. Li <thinker@branda.to> parents: 3 diff changeset	155 * It is attached under nexus bus, an on board device as `vordog0'.
e59963b503cb Remove tedious messages. Thinker K.F. Li <thinker@branda.to> parents: 3 diff changeset	156 */
e59963b503cb Remove tedious messages. Thinker K.F. Li <thinker@branda.to> parents: 3 diff changeset	157
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	158 static void vordog_identify(driver_t *driver, device_t parent) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	159 device_t vordog;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	160
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	161 /* make sure vordog device is not in the bus. */
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	162 vordog = device_find_child(parent, "vordog", 0);
1 0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	163 if(vordog != NULL)
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	164 return;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	165 vordog = BUS_ADD_CHILD(parent, 10, "vordog", 0);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	166 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	167
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	168 static int vordog_probe(device_t dev) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	169 int b;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	170
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	171 b = inb(VD_INITVAL);
1 0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	172 if(b != 0)
0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	173 return EINVAL;
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	174 b = inb(VD_CTR);
1 0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	175 if(b != 0)
0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	176 return EINVAL;
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	177 b = inb(VD_STATUS);
1 0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	178 if(b != 0)
0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	179 return EINVAL;
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	180 return 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	181 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	182
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	183 static int vordog_attach(device_t dev) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	184 vd_softc_t sc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	185 struct cdev *_cdev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	186
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	187 sc = (vd_softc_t)malloc(sizeof(struct vd_softc), M_TEMP, M_WAITOK);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	188 if(sc == NULL)
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	189 return ENOMEM;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	190
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	191 _cdev = make_dev(&vordog_cdevsw, 0, UID_ROOT, GID_WHEEL, 0600, "vordog0");
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	192 if(_cdev == NULL) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	193 free(sc, M_TEMP);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	194 return EINVAL;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	195 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	196
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	197 sc->_cdev = _cdev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	198 sc->dev = dev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	199
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	200 device_set_softc(dev, sc);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	201 CDEV_2_SOFTC(_cdev) = sc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	202
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	203 sc->open_cnt = 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	204 sc->init_val = 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	205
1 0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	206 device_set_desc(dev, "Watchdog of Vortex86 SoC");
0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	207 device_printf(dev, "<Vortex86 SoC watchdog> at port 0x%x\n", VD_STATUS);
0b9854adb86c Remove tedious messages and daemonize vd_watchdog. Thinker K.F. Li <thinker@branda.to> parents: 0 diff changeset	208
0 71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	209 return 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	210 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	211
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	212 static int vordog_detach(device_t dev) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	213 vd_softc_t sc;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	214 struct cdev *_cdev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	215
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	216 sc = device_get_softc(dev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	217 if(sc->open_cnt != 0)
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	218 return EBUSY;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	219
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	220 _cdev = sc->_cdev;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	221
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	222 destroy_dev(_cdev);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	223
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	224 free(sc, M_TEMP);
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	225
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	226 return 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	227 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	228
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	229 static device_method_t vordog_methods[] = {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	230 DEVMETHOD(device_identify, vordog_identify),
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	231 DEVMETHOD(device_probe, vordog_probe),
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	232 DEVMETHOD(device_attach, vordog_attach),
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	233 DEVMETHOD(device_detach, vordog_detach),
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	234 {0, 0}
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	235 };
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	236
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	237 static driver_t vordog_driver = {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	238 "vordog",
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	239 vordog_methods,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	240 0,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	241 };
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	242
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	243 static int
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	244 vordog_evh(module_t mod, int cmd, void *arg) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	245 int r = 0;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	246
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	247 switch(cmd) {
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	248 case MOD_LOAD:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	249 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	250 case MOD_UNLOAD:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	251 vordog_go_detach(); /* remove device from parent */
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	252 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	253 case MOD_SHUTDOWN:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	254 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	255 default:
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	256 r = EINVAL;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	257 break;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	258 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	259 return r;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	260 }
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	261
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	262 static devclass_t vordog_devclass;
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	263
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	264 DRIVER_MODULE(vordog, nexus, vordog_driver, vordog_devclass,
71475f5afa92 Watchdog for Vortex86 6071 on FreeBSD Thinker K.F. Li <thinker@branda.to> parents: diff changeset	265 vordog_evh, NULL);

Mercurial > vordog

annotate vordog.c @ 5:e59963b503cb