454 lines
11 KiB
C
454 lines
11 KiB
C
/* $NetBSD: ubsa_common.c,v 1.15 2021/06/13 09:29:38 mlelstv Exp $ */
|
|
/*-
|
|
* Copyright (c) 2002, Alexander Kabaev <kan.FreeBSD.org>.
|
|
* All rights reserved.
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``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 THE AUTHOR OR CONTRIBUTORS 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.
|
|
*/
|
|
/*
|
|
* Copyright (c) 2001 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Ichiro FUKUHARA (ichiro@ichiro.org).
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
|
* ``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 THE FOUNDATION OR CONTRIBUTORS
|
|
* 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: ubsa_common.c,v 1.15 2021/06/13 09:29:38 mlelstv Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/kmem.h>
|
|
#include <sys/ioccom.h>
|
|
#include <sys/fcntl.h>
|
|
#include <sys/conf.h>
|
|
#include <sys/tty.h>
|
|
#include <sys/file.h>
|
|
#include <sys/select.h>
|
|
#include <sys/proc.h>
|
|
#include <sys/device.h>
|
|
#include <sys/poll.h>
|
|
#include <sys/sysctl.h>
|
|
#include <sys/bus.h>
|
|
|
|
#include <dev/usb/usb.h>
|
|
#include <dev/usb/usbdi.h>
|
|
#include <dev/usb/usbdi_util.h>
|
|
#include <dev/usb/usbdivar.h>
|
|
|
|
#include <dev/usb/usbcdc.h>
|
|
#include <dev/usb/usbdevs.h>
|
|
#include <dev/usb/usb_quirks.h>
|
|
#include <dev/usb/ucomvar.h>
|
|
#include <dev/usb/ubsavar.h>
|
|
|
|
#ifdef UBSA_DEBUG
|
|
extern int ubsadebug;
|
|
#define DPRINTFN(n, x) do { \
|
|
if (ubsadebug > (n)) \
|
|
printf x; \
|
|
} while (0)
|
|
#else
|
|
#define DPRINTFN(n, x)
|
|
#endif
|
|
#define DPRINTF(x) DPRINTFN(0, x)
|
|
|
|
int
|
|
ubsa_request(struct ubsa_softc *sc, int portno, uint8_t request, uint16_t value)
|
|
{
|
|
usb_device_request_t req;
|
|
usbd_status err;
|
|
|
|
if (sc->sc_quadumts)
|
|
req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
|
|
else
|
|
req.bmRequestType = UT_WRITE_VENDOR_DEVICE;
|
|
|
|
if (portno >= UBSA_MAXCONN) {
|
|
printf("%s: ubsa_request: invalid port(%d)#\n",
|
|
device_xname(sc->sc_dev), portno);
|
|
return USBD_INVAL;
|
|
}
|
|
|
|
req.bRequest = request;
|
|
USETW(req.wValue, value);
|
|
USETW(req.wIndex, sc->sc_iface_number[portno]);
|
|
USETW(req.wLength, 0);
|
|
|
|
err = usbd_do_request(sc->sc_udev, &req, 0);
|
|
if (err)
|
|
printf("%s: ubsa_request: %s\n",
|
|
device_xname(sc->sc_dev), usbd_errstr(err));
|
|
return err;
|
|
}
|
|
|
|
void
|
|
ubsa_dtr(struct ubsa_softc *sc, int portno, int onoff)
|
|
{
|
|
|
|
DPRINTF(("ubsa_dtr: onoff = %d\n", onoff));
|
|
|
|
if (sc->sc_dtr == onoff)
|
|
return;
|
|
sc->sc_dtr = onoff;
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_DTR, onoff ? 1 : 0);
|
|
}
|
|
|
|
void
|
|
ubsa_rts(struct ubsa_softc *sc, int portno, int onoff)
|
|
{
|
|
|
|
DPRINTF(("ubsa_rts: onoff = %d\n", onoff));
|
|
|
|
if (sc->sc_rts == onoff)
|
|
return;
|
|
sc->sc_rts = onoff;
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_RTS, onoff ? 1 : 0);
|
|
}
|
|
|
|
void
|
|
ubsa_quadumts_dtr(struct ubsa_softc *sc, int portno, int onoff)
|
|
{
|
|
|
|
DPRINTF(("ubsa_dtr: onoff = %d\n", onoff));
|
|
|
|
if (sc->sc_dtr == onoff)
|
|
return;
|
|
sc->sc_dtr = onoff;
|
|
|
|
ubsa_request(sc, portno, UBSA_QUADUMTS_SET_PIN,
|
|
(sc->sc_rts ? 2 : 0)+(sc->sc_dtr ? 1 : 0));
|
|
}
|
|
|
|
void
|
|
ubsa_quadumts_rts(struct ubsa_softc *sc, int portno, int onoff)
|
|
{
|
|
|
|
DPRINTF(("ubsa_rts: onoff = %d\n", onoff));
|
|
|
|
if (sc->sc_rts == onoff)
|
|
return;
|
|
sc->sc_rts = onoff;
|
|
|
|
ubsa_request(sc, portno, UBSA_QUADUMTS_SET_PIN,
|
|
(sc->sc_rts ? 2 : 0)+(sc->sc_dtr ? 1 : 0));
|
|
}
|
|
|
|
void
|
|
ubsa_break(struct ubsa_softc *sc, int portno, int onoff)
|
|
{
|
|
DPRINTF(("ubsa_rts: onoff = %d\n", onoff));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_BREAK, onoff ? 1 : 0);
|
|
}
|
|
|
|
void
|
|
ubsa_set(void *addr, int portno, int reg, int onoff)
|
|
{
|
|
struct ubsa_softc *sc = addr;
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
switch (reg) {
|
|
case UCOM_SET_DTR:
|
|
if (sc->sc_quadumts)
|
|
ubsa_quadumts_dtr(sc, portno, onoff);
|
|
else
|
|
ubsa_dtr(sc, portno, onoff);
|
|
break;
|
|
case UCOM_SET_RTS:
|
|
if (sc->sc_quadumts)
|
|
ubsa_quadumts_rts(sc, portno, onoff);
|
|
else
|
|
ubsa_rts(sc, portno, onoff);
|
|
break;
|
|
case UCOM_SET_BREAK:
|
|
if (!sc->sc_quadumts)
|
|
ubsa_break(sc, portno, onoff);
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
void
|
|
ubsa_baudrate(struct ubsa_softc *sc, int portno, speed_t speed)
|
|
{
|
|
uint16_t value = 0;
|
|
|
|
DPRINTF(("ubsa_baudrate: speed = %d\n", speed));
|
|
|
|
switch(speed) {
|
|
case B0:
|
|
break;
|
|
case B300:
|
|
case B600:
|
|
case B1200:
|
|
case B2400:
|
|
case B4800:
|
|
case B9600:
|
|
case B19200:
|
|
case B38400:
|
|
case B57600:
|
|
case B115200:
|
|
case B230400:
|
|
value = B230400 / speed;
|
|
break;
|
|
default:
|
|
printf("%s: ubsa_param: unsupported baudrate, "
|
|
"forcing default of 9600\n",
|
|
device_xname(sc->sc_dev));
|
|
value = B230400 / B9600;
|
|
break;
|
|
};
|
|
|
|
if (speed == B0) {
|
|
ubsa_flow(sc, portno, 0, 0);
|
|
ubsa_dtr(sc, portno, 0);
|
|
ubsa_rts(sc, portno, 0);
|
|
} else
|
|
ubsa_request(sc, portno, UBSA_SET_BAUDRATE, value);
|
|
}
|
|
|
|
void
|
|
ubsa_parity(struct ubsa_softc *sc, int portno, tcflag_t cflag)
|
|
{
|
|
int value;
|
|
|
|
DPRINTF(("ubsa_parity: cflag = %#x\n", cflag));
|
|
|
|
if (cflag & PARENB)
|
|
value = (cflag & PARODD) ? UBSA_PARITY_ODD : UBSA_PARITY_EVEN;
|
|
else
|
|
value = UBSA_PARITY_NONE;
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_PARITY, value);
|
|
}
|
|
|
|
void
|
|
ubsa_databits(struct ubsa_softc *sc, int portno, tcflag_t cflag)
|
|
{
|
|
int value;
|
|
|
|
DPRINTF(("ubsa_databits: cflag = %#x\n", cflag));
|
|
|
|
switch (cflag & CSIZE) {
|
|
case CS5: value = 0; break;
|
|
case CS6: value = 1; break;
|
|
case CS7: value = 2; break;
|
|
case CS8: value = 3; break;
|
|
default:
|
|
printf("%s: ubsa_param: unsupported databits requested, "
|
|
"forcing default of 8\n",
|
|
device_xname(sc->sc_dev));
|
|
value = 3;
|
|
}
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_DATA_BITS, value);
|
|
}
|
|
|
|
void
|
|
ubsa_stopbits(struct ubsa_softc *sc, int portno, tcflag_t cflag)
|
|
{
|
|
int value;
|
|
|
|
DPRINTF(("ubsa_stopbits: cflag = %#x\n", cflag));
|
|
|
|
value = (cflag & CSTOPB) ? 1 : 0;
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_STOP_BITS, value);
|
|
}
|
|
|
|
void
|
|
ubsa_flow(struct ubsa_softc *sc, int portno, tcflag_t cflag, tcflag_t iflag)
|
|
{
|
|
int value;
|
|
|
|
DPRINTF(("ubsa_flow: cflag = %#x, iflag = %#x\n", cflag, iflag));
|
|
|
|
value = 0;
|
|
if (cflag & CRTSCTS)
|
|
value |= UBSA_FLOW_OCTS | UBSA_FLOW_IRTS;
|
|
if (iflag & IXOFF)
|
|
value |= UBSA_FLOW_OXON;
|
|
if (iflag & IXON)
|
|
value |= UBSA_FLOW_IXON;
|
|
|
|
ubsa_request(sc, portno, UBSA_SET_FLOW_CTRL, value);
|
|
}
|
|
|
|
int
|
|
ubsa_param(void *addr, int portno, struct termios *ti)
|
|
{
|
|
struct ubsa_softc *sc = addr;
|
|
|
|
if (sc->sc_dying)
|
|
return EIO;
|
|
|
|
DPRINTF(("ubsa_param: sc = %p\n", sc));
|
|
|
|
if (!sc->sc_quadumts) {
|
|
ubsa_baudrate(sc, portno, ti->c_ospeed);
|
|
ubsa_parity(sc, portno, ti->c_cflag);
|
|
ubsa_databits(sc, portno, ti->c_cflag);
|
|
ubsa_stopbits(sc, portno, ti->c_cflag);
|
|
ubsa_flow(sc, portno, ti->c_cflag, ti->c_iflag);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
int
|
|
ubsa_open(void *addr, int portno)
|
|
{
|
|
struct ubsa_softc *sc = addr;
|
|
int err;
|
|
|
|
if (sc->sc_dying)
|
|
return EIO;
|
|
|
|
if (sc->sc_intr_number != -1 && sc->sc_intr_pipe == NULL) {
|
|
sc->sc_intr_buf = kmem_alloc(sc->sc_isize, KM_SLEEP);
|
|
/* XXX only iface# = 0 has intr line */
|
|
/* XXX E220 specific? need to check */
|
|
err = usbd_open_pipe_intr(sc->sc_iface[0],
|
|
sc->sc_intr_number,
|
|
USBD_SHORT_XFER_OK,
|
|
&sc->sc_intr_pipe,
|
|
sc,
|
|
sc->sc_intr_buf,
|
|
sc->sc_isize,
|
|
ubsa_intr,
|
|
UBSA_INTR_INTERVAL);
|
|
if (err) {
|
|
printf("%s: cannot open interrupt pipe (addr %d)\n",
|
|
device_xname(sc->sc_dev),
|
|
sc->sc_intr_number);
|
|
return EIO;
|
|
}
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
void
|
|
ubsa_close_pipe(struct ubsa_softc *sc)
|
|
{
|
|
|
|
if (sc->sc_intr_pipe != NULL) {
|
|
usbd_abort_pipe(sc->sc_intr_pipe);
|
|
usbd_close_pipe(sc->sc_intr_pipe);
|
|
sc->sc_intr_pipe = NULL;
|
|
}
|
|
if (sc->sc_intr_buf) {
|
|
kmem_free(sc->sc_intr_buf, sc->sc_isize);
|
|
sc->sc_intr_buf = NULL;
|
|
}
|
|
}
|
|
|
|
void
|
|
ubsa_close(void *addr, int portno)
|
|
{
|
|
struct ubsa_softc *sc = addr;
|
|
|
|
DPRINTF(("ubsa_close: close\n"));
|
|
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
ubsa_close_pipe(sc);
|
|
}
|
|
|
|
void
|
|
ubsa_intr(struct usbd_xfer *xfer, void *priv,
|
|
usbd_status status)
|
|
{
|
|
struct ubsa_softc *sc = priv;
|
|
u_char *buf;
|
|
int i;
|
|
|
|
buf = sc->sc_intr_buf;
|
|
if (sc->sc_dying)
|
|
return;
|
|
|
|
if (status != USBD_NORMAL_COMPLETION) {
|
|
if (status == USBD_NOT_STARTED || status == USBD_CANCELLED)
|
|
return;
|
|
|
|
DPRINTF(("%s: ubsa_intr: abnormal status: %s\n",
|
|
device_xname(sc->sc_dev), usbd_errstr(status)));
|
|
usbd_clear_endpoint_stall_async(sc->sc_intr_pipe);
|
|
return;
|
|
}
|
|
|
|
/* incidentally, Belkin adapter status bits match UART 16550 bits */
|
|
sc->sc_lsr = buf[2];
|
|
sc->sc_msr = buf[3];
|
|
|
|
DPRINTF(("%s: ubsa lsr = 0x%02x, msr = 0x%02x\n",
|
|
device_xname(sc->sc_dev), sc->sc_lsr, sc->sc_msr));
|
|
|
|
for (i = 0; i < sc->sc_numif; i++) {
|
|
ucom_status_change(device_private(sc->sc_subdevs[i]));
|
|
}
|
|
}
|
|
|
|
void
|
|
ubsa_get_status(void *addr, int portno, u_char *lsr, u_char *msr)
|
|
{
|
|
struct ubsa_softc *sc = addr;
|
|
|
|
DPRINTF(("ubsa_get_status\n"));
|
|
|
|
*lsr = sc->sc_lsr;
|
|
*msr = sc->sc_msr;
|
|
}
|
|
|