root/sys/arch/landisk/dev/button.c
/*      $NetBSD: button.c,v 1.15 2021/09/29 15:17:01 thorpej Exp $      */

/*
 * Copyright (c) 2003 Wasabi Systems, Inc.
 * All rights reserved.
 *
 * Written by Jason R. Thorpe for Wasabi Systems, Inc.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. Redistributions in binary form must reproduce the above copyright
 *    notice, this list of conditions and the following disclaimer in the
 *    documentation and/or other materials provided with the distribution.
 * 3. All advertising materials mentioning features or use of this software
 *    must display the following acknowledgement:
 *      This product includes software developed for the NetBSD Project by
 *      Wasabi Systems, Inc.
 * 4. The name of Wasabi Systems, Inc. may not be used to endorse
 *    or promote products derived from this software without specific prior
 *    written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
 * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL WASABI SYSTEMS, INC
 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 */

#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: button.c,v 1.15 2021/09/29 15:17:01 thorpej Exp $");

#include <sys/param.h>
#include <sys/conf.h>
#include <sys/systm.h>
#include <sys/queue.h>
#include <sys/mutex.h>
#include <sys/errno.h>
#include <sys/fcntl.h>
#include <sys/callout.h>
#include <sys/kernel.h>
#include <sys/once.h>
#include <sys/poll.h>
#include <sys/select.h>
#include <sys/vnode.h>

#include <machine/button.h>

#include <landisk/dev/buttonvar.h>

/*
 * event handler
 */
static LIST_HEAD(, btn_event) btn_event_list;
static kmutex_t btn_event_list_lock;

static struct lwp *btn_daemon;

#define BTN_MAX_EVENTS          32

static kmutex_t btn_event_queue_lock;
static kcondvar_t btn_event_queue_cv;

static button_event_t btn_event_queue[BTN_MAX_EVENTS];
static int btn_event_queue_head;
static int btn_event_queue_tail;
static int btn_event_queue_count;
static int btn_event_queue_flags;
static struct selinfo btn_event_queue_selinfo;

static char btn_type[32];

#define BEVQ_F_WAITING          0x01    /* daemon waiting for event */

#define BTN_NEXT_EVENT(x)       (((x) + 1) / BTN_MAX_EVENTS)

dev_type_open(btnopen);
dev_type_close(btnclose);
dev_type_ioctl(btnioctl);
dev_type_read(btnread);
dev_type_poll(btnpoll);
dev_type_kqfilter(btnkqfilter);

const struct cdevsw button_cdevsw = {
        .d_open = btnopen,
        .d_close = btnclose,
        .d_read = btnread,
        .d_write = nowrite,
        .d_ioctl = btnioctl,
        .d_stop = nostop,
        .d_tty = notty,
        .d_poll = btnpoll,
        .d_mmap = nommap,
        .d_kqfilter = btnkqfilter,
        .d_discard = nodiscard,
        .d_flag = 0
};

int
btn_init(void)
{

        LIST_INIT(&btn_event_list);
        mutex_init(&btn_event_list_lock, MUTEX_DEFAULT, IPL_NONE);
        mutex_init(&btn_event_queue_lock, MUTEX_DEFAULT, IPL_NONE);
        cv_init(&btn_event_queue_cv, "btncv");
        selinit(&btn_event_queue_selinfo);

        return 0;
}

static int
btn_queue_event(button_event_t *bev)
{

        if (btn_event_queue_count == BTN_MAX_EVENTS)
                return (0);

        btn_event_queue[btn_event_queue_head] = *bev;
        btn_event_queue_head = BTN_NEXT_EVENT(btn_event_queue_head);
        btn_event_queue_count++;

        return (1);
}

static int
btn_get_event(button_event_t *bev)
{

        if (btn_event_queue_count == 0)
                return (0);

        *bev = btn_event_queue[btn_event_queue_tail];
        btn_event_queue_tail = BTN_NEXT_EVENT(btn_event_queue_tail);
        btn_event_queue_count--;

        return (1);
}

static void
btn_event_queue_flush(void)
{

        btn_event_queue_head = 0;
        btn_event_queue_tail = 0;
        btn_event_queue_count = 0;
        btn_event_queue_flags = 0;
}

int
btnopen(dev_t dev, int flag, int mode, struct lwp *l)
{
        int error;

        if (minor(dev) != 0) {
                return (ENODEV);
        }

        mutex_enter(&btn_event_queue_lock);
        if (btn_daemon != NULL) {
                error = EBUSY;
        } else {
                error = 0;
                btn_daemon = l;
                btn_event_queue_flush();
        }
        mutex_exit(&btn_event_queue_lock);

        return (error);
}

int
btnclose(dev_t dev, int flag, int mode, struct lwp *l)
{
        int count;

        if (minor(dev) != 0) {
                return (ENODEV);
        }

        mutex_enter(&btn_event_queue_lock);
        count = btn_event_queue_count;
        btn_daemon = NULL;
        btn_event_queue_flush();
        mutex_exit(&btn_event_queue_lock);

        if (count) {
                printf("WARNING: %d events lost by exiting daemon\n", count);
        }

        return (0);
}

int
btnioctl(dev_t dev, u_long cmd, void *data, int flag, struct lwp *l)
{
        int error = 0;

        if (minor(dev) != 0) {
                return (ENODEV);
        }

        switch (cmd) {
        case BUTTON_IOC_GET_TYPE:
            {
                struct button_type *button_type = (void *)data;
                strcpy(button_type->button_type, btn_type);
                break;
            }

        default:
                error = ENOTTY;
                break;
        }

        return (error);
}

int
btnread(dev_t dev, struct uio *uio, int flags)
{
        button_event_t bev;
        int error;

        if (minor(dev) != 0) {
                return (ENODEV);
        }

        if (uio->uio_resid != BUTTON_EVENT_MSG_SIZE) {
                return (EINVAL);
        }

        mutex_enter(&btn_event_queue_lock);
        for (;;) {
                if (btn_get_event(&bev)) {
                        mutex_exit(&btn_event_queue_lock);
                        return (uiomove(&bev, BUTTON_EVENT_MSG_SIZE, uio));
                }

                if (flags & IO_NDELAY) {
                        mutex_exit(&btn_event_queue_lock);
                        return (EWOULDBLOCK);
                }

                btn_event_queue_flags |= BEVQ_F_WAITING;
                error = cv_wait_sig(&btn_event_queue_cv, &btn_event_queue_lock);
                if (error) {
                        mutex_exit(&btn_event_queue_lock);
                        return (error);
                }
        }
}

int
btnpoll(dev_t dev, int events, struct lwp *l)
{
        int revents;

        if (minor(dev) != 0) {
                return (ENODEV);
        }

        revents = events & (POLLOUT | POLLWRNORM);

        /* Attempt to save some work. */
        if ((events & (POLLIN | POLLRDNORM)) == 0)
                return (revents);

        mutex_enter(&btn_event_queue_lock);
        if (btn_event_queue_count) {
                revents |= events & (POLLIN | POLLRDNORM);
        } else {
                selrecord(l, &btn_event_queue_selinfo);
        }
        mutex_exit(&btn_event_queue_lock);

        return (revents);
}

static void
filt_btn_rdetach(struct knote *kn)
{

        mutex_enter(&btn_event_queue_lock);
        selremove_knote(&btn_event_queue_selinfo, kn);
        mutex_exit(&btn_event_queue_lock);
}

static int
filt_btn_read(struct knote *kn, long hint)
{
        int rv;

        if (hint & NOTE_SUBMIT) {
                KASSERT(mutex_owned(&btn_event_queue_lock));
        } else {
                mutex_enter(&btn_event_queue_lock);
        }

        kn->kn_data = btn_event_queue_count;
        rv = kn->kn_data > 0;

        if ((hint & NOTE_SUBMIT) == 0) {
                mutex_exit(&btn_event_queue_lock);
        }

        return rv;
}

static const struct filterops btn_read_filtops = {
    .f_flags = FILTEROP_ISFD | FILTEROP_MPSAFE,
    .f_attach = NULL,
    .f_detach = filt_btn_rdetach,
    .f_event = filt_btn_read,
};

int
btnkqfilter(dev_t dev, struct knote *kn)
{

        if (minor(dev) != 0) {
                return (ENODEV);
        }

        switch (kn->kn_filter) {
        case EVFILT_READ:
                kn->kn_fop = &btn_read_filtops;
                mutex_enter(&btn_event_queue_lock);
                selrecord_knote(&btn_event_queue_selinfo, kn);
                mutex_exit(&btn_event_queue_lock);
                break;

        case EVFILT_WRITE:
                kn->kn_fop = &seltrue_filtops;
                break;

        default:
                return (EINVAL);
        }

        return (0);
}

void
btn_settype(const char *type)
{

        /*
         * Don't bother locking this; it's going to be set
         * during autoconfiguration, and then only read from
         * then on.
         */
        strlcpy(btn_type, type, sizeof(btn_type));
}

int
btn_event_register(struct btn_event *bev)
{

        mutex_enter(&btn_event_list_lock);
        LIST_INSERT_HEAD(&btn_event_list, bev, bev_list);
        mutex_exit(&btn_event_list_lock);

        return (0);
}

void
btn_event_unregister(struct btn_event *bev)
{

        mutex_enter(&btn_event_list_lock);
        LIST_REMOVE(bev, bev_list);
        mutex_exit(&btn_event_list_lock);
}

void
btn_event_send(struct btn_event *bev, int event)
{
        button_event_t btnev;
        int rv;

        mutex_enter(&btn_event_queue_lock);
        if (btn_daemon == NULL) {
                mutex_exit(&btn_event_queue_lock);
                printf("%s: btn_event_send can't handle me.\n", bev->bev_name);
                return;
        }

        btnev.bev_type = BUTTON_EVENT_STATE_CHANGE;
        btnev.bev_event.bs_state = event;
        strcpy(btnev.bev_event.bs_name, bev->bev_name);

        rv = btn_queue_event(&btnev);
        if (rv == 0) {
                mutex_exit(&btn_event_queue_lock);
                printf("%s: WARNING: state change event %d lost; "
                    "queue full\n", bev->bev_name, btnev.bev_type);
                return;
        }
        if (btn_event_queue_flags & BEVQ_F_WAITING) {
                btn_event_queue_flags &= ~BEVQ_F_WAITING;
                cv_broadcast(&btn_event_queue_cv);
        }
        selnotify(&btn_event_queue_selinfo, POLLIN | POLLRDNORM, NOTE_SUBMIT);
        mutex_exit(&btn_event_queue_lock);
}