c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/*
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * CDDL HEADER START
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx *
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * The contents of this file are subject to the terms of the
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * Common Development and Distribution License (the "License").
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * You may not use this file except in compliance with the License.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx *
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * or http://www.opensolaris.org/os/licensing.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * See the License for the specific language governing permissions
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * and limitations under the License.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx *
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * When distributing Covered Code, include this CDDL HEADER in each
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * If applicable, add the following below this CDDL HEADER, with the
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * fields enclosed by brackets "[]" replaced with your own identifying
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * information: Portions Copyright [yyyy] [name of copyright owner]
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx *
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * CDDL HEADER END
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/*
613b28719c10e84c1202c1045df44d77767de21dRichard Bean * Copyright 2008 Sun Microsystems, Inc. All rights reserved.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * Use is subject to license terms.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/*
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * Simple beeper support for PC platform, using standard timer 2 beeper.
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/types.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/conf.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/beep.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/ksynch.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/ddi.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/sunddi.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/modctl.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/pit.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#include <sys/inttypes.h>
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#define PIT_BEEP_UNIT(dev) (getminor((dev)))
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxtypedef struct pit_beep_state {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx /* Dip of pit_beep device */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx dev_info_t *dip;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx} pit_beep_state_t;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#define PIT_BEEP_ON 1
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx#define PIT_BEEP_OFF 0
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/* Pointer to the state structure */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void *pit_beep_statep;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic int pit_beep_attach(dev_info_t *dip, ddi_attach_cmd_t cmd);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic int pit_beep_detach(dev_info_t *dip, ddi_detach_cmd_t cmd);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic int pit_beep_info(dev_info_t *dip, ddi_info_cmd_t infocmd,
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx void *arg, void **result);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void pit_beep_freq(void *arg, int freq);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void pit_beep_on(void *arg);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void pit_beep_off(void *arg);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstruct cb_ops pit_beep_cb_ops = {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* open */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* close */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* strategy */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* print */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* dump */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* read */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* write */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* ioctl */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* devmap */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* mmap */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* segmap */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nochpoll, /* poll */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx ddi_prop_op, /* cb_prop_op */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx NULL, /* streamtab */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx D_MP | D_NEW
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx};
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic struct dev_ops pit_beep_ops = {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx DEVO_REV, /* Devo_rev */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx 0, /* Refcnt */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx pit_beep_info, /* Info */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* Identify */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nulldev, /* Probe */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx pit_beep_attach, /* Attach */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx pit_beep_detach, /* Detach */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx nodev, /* Reset */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx &pit_beep_cb_ops, /* Driver operations */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx 0, /* Bus operations */
193974072f41a843678abf5f61979c748687e66bSherry Moore NULL, /* Power */
193974072f41a843678abf5f61979c748687e66bSherry Moore ddi_quiesce_not_needed, /* quiesce */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx};
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic struct modldrv modldrv = {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx &mod_driverops, /* This one is a driver */
613b28719c10e84c1202c1045df44d77767de21dRichard Bean "Intel Pit_beep Driver", /* Name of the module. */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx &pit_beep_ops, /* Driver ops */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx};
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic struct modlinkage modlinkage = {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx MODREV_1, (void *)&modldrv, NULL
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx};
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxint
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx_init(void)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx int error;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx /* Initialize the soft state structures */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if ((error = ddi_soft_state_init(&pit_beep_statep,
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx sizeof (pit_beep_state_t), 1)) != 0) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (error);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx /* Install the loadable module */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if ((error = mod_install(&modlinkage)) != 0) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx ddi_soft_state_fini(&pit_beep_statep);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (error);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxint
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx_info(struct modinfo *modinfop)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (mod_info(&modlinkage, modinfop));
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxint
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx_fini(void)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx int error;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx error = mod_remove(&modlinkage);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if (error == 0) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx /* Release per module resources */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx ddi_soft_state_fini(&pit_beep_statep);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (error);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/*
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * pit_beep_attach:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic int
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxpit_beep_attach(dev_info_t *dip, ddi_attach_cmd_t cmd)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx switch (cmd) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx case DDI_ATTACH:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx break;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx case DDI_RESUME:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_SUCCESS);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx default:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_FAILURE);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx pit_beep_off(dip);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx (void) beep_init((void *)dip, pit_beep_on, pit_beep_off,
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx pit_beep_freq);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx /* Display information in the banner */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx ddi_report_dev(dip);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_SUCCESS);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/*
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * pit_beep_detach:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/* ARGSUSED */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic int
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxpit_beep_detach(dev_info_t *dip, ddi_detach_cmd_t cmd)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx switch (cmd) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx case DDI_SUSPEND:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx /*
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * If a beep is in progress; fail suspend
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if (!beep_busy()) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_SUCCESS);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx } else {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_FAILURE);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx default:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_FAILURE);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/*
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx * pit_beep_info:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/* ARGSUSED */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic int
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxpit_beep_info(dev_info_t *dip, ddi_info_cmd_t infocmd,
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx void *arg, void **result)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx dev_t dev;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx pit_beep_state_t *statep;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx int instance, error;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx switch (infocmd) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx case DDI_INFO_DEVT2DEVINFO:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx dev = (dev_t)arg;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx instance = PIT_BEEP_UNIT(dev);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if ((statep = ddi_get_soft_state(pit_beep_statep,
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx instance)) == NULL) {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (DDI_FAILURE);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx *result = (void *)statep->dip;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx error = DDI_SUCCESS;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx break;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx case DDI_INFO_DEVT2INSTANCE:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx dev = (dev_t)arg;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx instance = PIT_BEEP_UNIT(dev);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx *result = (void *)(uintptr_t)instance;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx error = DDI_SUCCESS;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx break;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx default:
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx error = DDI_FAILURE;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx return (error);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/* ARGSUSED */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxpit_beep_freq(void *arg, int freq)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx int counter;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if (freq == 0)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx counter = 0;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx else {
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx counter = PIT_HZ / freq;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx if (counter > UINT16_MAX)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx counter = UINT16_MAX;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx else if (counter < 1)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx counter = 1;
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx }
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx outb(PITCTL_PORT, PIT_C2 | PIT_READMODE | PIT_RATEMODE);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx outb(PITCTR2_PORT, counter & 0xff);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx outb(PITCTR2_PORT, counter >> 8);
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/* ARGSUSED */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxpit_beep_on(void *arg)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx outb(PITAUX_PORT, inb(PITAUX_PORT) | (PITAUX_OUT2 | PITAUX_GATE2));
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx/* ARGSUSED */
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxstatic void
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarxpit_beep_off(void *arg)
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx{
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx outb(PITAUX_PORT, inb(PITAUX_PORT) & ~(PITAUX_OUT2 | PITAUX_GATE2));
c35aa225b9ae500f1d14f0d39a94f1eb6cda333dmarx}