NetBSD-5.0.2/sys/dev/usb/uhmodem.c
/* $NetBSD: uhmodem.c,v 1.7 2008/05/24 16:40:58 cube Exp $ */
/*
* Copyright (c) 2008 Yojiro UO <yuo@nui.org>.
* All rights reserved.
*
* Permission to use, copy, modify, and distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF MIND, USE, DATA OR PROFITS, WHETHER IN
* AN ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT
* OF OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*/
/*-
* 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: uhmodem.c,v 1.7 2008/05/24 16:40:58 cube Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/malloc.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>
/* vendor specific bRequest */
#define UHMODEM_REGWRITE 0x20
#define UHMODEM_REGREAD 0x21
#define UHMODEM_SETUP 0x22
#define UHMODEMIBUFSIZE 4096
#define UHMODEMOBUFSIZE 4096
#ifdef UHMODEM_DEBUG
Static int uhmodemdebug = 0;
#define DPRINTFN(n, x) do { \
if (uhmodemdebug > (n)) \
logprintf x; \
} while (0)
#else
#define DPRINTFN(n, x)
#endif
#define DPRINTF(x) DPRINTFN(0, x)
Static int uhmodem_open(void *, int);
Static usbd_status e220_modechange_request(usbd_device_handle);
Static usbd_status uhmodem_endpointhalt(struct ubsa_softc *, int);
Static usbd_status uhmodem_regwrite(usbd_device_handle, uint8_t *, size_t);
Static usbd_status uhmodem_regread(usbd_device_handle, uint8_t *, size_t);
Static usbd_status a2502_init(usbd_device_handle);
#if 0
Static usbd_status uhmodem_regsetup(usbd_device_handle, uint16_t);
Static usbd_status e220_init(usbd_device_handle);
#endif
struct uhmodem_softc {
struct ubsa_softc sc_ubsa;
};
struct ucom_methods uhmodem_methods = {
ubsa_get_status,
ubsa_set,
ubsa_param,
NULL,
uhmodem_open,
ubsa_close,
NULL,
NULL
};
struct uhmodem_type {
struct usb_devno uhmodem_dev;
u_int16_t uhmodem_coms; /* number of serial interfaces on the device */
u_int16_t uhmodem_flags;
#define E220 0x0001
#define A2502 0x0002
#define E620 0x0004 /* XXX */
/* Whether or not it is a device different from E220 is not clear. */
};
Static const struct uhmodem_type uhmodem_devs[] = {
/* HUAWEI E220 / Emobile D0[12]HW */
{{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_E220 }, 2, E220},
/* ANYDATA / NTT DoCoMo A2502 */
{{ USB_VENDOR_ANYDATA, USB_PRODUCT_ANYDATA_A2502 }, 3, A2502},
/* HUAWEI E620 */
{{ USB_VENDOR_HUAWEI, USB_PRODUCT_HUAWEI_MOBILE }, 3, E620},
};
#define uhmodem_lookup(v, p) ((const struct uhmodem_type *)usb_lookup(uhmodem_devs, v, p))
int uhmodem_match(device_t, cfdata_t, void *);
void uhmodem_attach(device_t, device_t, void *);
void uhmodem_childdet(device_t, device_t);
int uhmodem_detach(device_t, int);
int uhmodem_activate(device_t, enum devact);
extern struct cfdriver uhmodem_cd;
CFATTACH_DECL2_NEW(uhmodem, sizeof(struct uhmodem_softc), uhmodem_match,
uhmodem_attach, uhmodem_detach, uhmodem_activate, NULL, uhmodem_childdet);
USB_MATCH(uhmodem)
{
USB_IFMATCH_START(uhmodem, uaa);
if (uhmodem_lookup(uaa->vendor, uaa->product) != NULL)
/* XXX interface# 0,1 provide modem function, but this driver
handles all modem in single device. */
if (uaa->ifaceno == 0)
return (UMATCH_VENDOR_PRODUCT);
return (UMATCH_NONE);
}
USB_ATTACH(uhmodem)
{
USB_IFATTACH_START(uhmodem, sc, uaa);
usbd_device_handle dev = uaa->device;
usb_config_descriptor_t *cdesc;
usb_interface_descriptor_t *id;
usb_endpoint_descriptor_t *ed;
char *devinfop;
usbd_status err;
struct ucom_attach_args uca;
int i;
int j;
char comname[16];
devinfop = usbd_devinfo_alloc(dev, 0);
USB_ATTACH_SETUP;
aprint_normal_dev(self, "%s\n", devinfop);
usbd_devinfo_free(devinfop);
sc->sc_ubsa.sc_dev = self;
sc->sc_ubsa.sc_udev = dev;
sc->sc_ubsa.sc_config_index = UBSA_DEFAULT_CONFIG_INDEX;
sc->sc_ubsa.sc_numif = 1; /* defaut device has one interface */
/* Hauwei E220 need special request to change its mode to modem */
if ((uaa->ifaceno == 0) && (uaa->class != 255)) {
err = e220_modechange_request(dev);
if (err) {
aprint_error_dev(self, "failed to change mode: %s\n",
usbd_errstr(err));
sc->sc_ubsa.sc_dying = 1;
goto error;
}
aprint_error_dev(self,
"mass storage only mode, reattach to enable modem\n");
sc->sc_ubsa.sc_dying = 1;
goto error;
}
/*
* initialize rts, dtr variables to something
* different from boolean 0, 1
*/
sc->sc_ubsa.sc_dtr = -1;
sc->sc_ubsa.sc_rts = -1;
sc->sc_ubsa.sc_quadumts = 1;
sc->sc_ubsa.sc_config_index = 0;
sc->sc_ubsa.sc_numif = uhmodem_lookup(uaa->vendor, uaa->product)->uhmodem_coms;
sc->sc_ubsa.sc_devflags = uhmodem_lookup(uaa->vendor, uaa->product)->uhmodem_flags;
DPRINTF(("uhmodem attach: sc = %p\n", sc));
/* Move the device into the configured state. */
err = usbd_set_config_index(dev, sc->sc_ubsa.sc_config_index, 1);
if (err) {
aprint_error_dev(self, "failed to set configuration: %s\n",
usbd_errstr(err));
sc->sc_ubsa.sc_dying = 1;
goto error;
}
/* get the config descriptor */
cdesc = usbd_get_config_descriptor(sc->sc_ubsa.sc_udev);
if (cdesc == NULL) {
aprint_error_dev(self,
"failed to get configuration descriptor\n");
sc->sc_ubsa.sc_dying = 1;
goto error;
}
sc->sc_ubsa.sc_intr_number = -1;
sc->sc_ubsa.sc_intr_pipe = NULL;
/* get the interfaces */
for (i = 0; i < sc->sc_ubsa.sc_numif; i++) {
err = usbd_device2interface_handle(dev, UBSA_IFACE_INDEX_OFFSET+i,
&sc->sc_ubsa.sc_iface[i]);
if (err) {
if (i == 0){
/* can not get main interface */
sc->sc_ubsa.sc_dying = 1;
goto error;
} else
break;
}
/* Find the endpoints */
id = usbd_get_interface_descriptor(sc->sc_ubsa.sc_iface[i]);
sc->sc_ubsa.sc_iface_number[i] = id->bInterfaceNumber;
/* initialize endpoints */
uca.bulkin = uca.bulkout = -1;
for (j = 0; j < id->bNumEndpoints; j++) {
ed = usbd_interface2endpoint_descriptor(
sc->sc_ubsa.sc_iface[i], j);
if (ed == NULL) {
aprint_error_dev(self,
"no endpoint descriptor for %d "
"(interface: %d)\n", j, i);
break;
}
if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
UE_GET_XFERTYPE(ed->bmAttributes) == UE_INTERRUPT) {
sc->sc_ubsa.sc_intr_number = ed->bEndpointAddress;
sc->sc_ubsa.sc_isize = UGETW(ed->wMaxPacketSize);
} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_IN &&
UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
uca.bulkin = ed->bEndpointAddress;
} else if (UE_GET_DIR(ed->bEndpointAddress) == UE_DIR_OUT &&
UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
uca.bulkout = ed->bEndpointAddress;
}
} /* end of Endpoint loop */
if (sc->sc_ubsa.sc_intr_number == -1) {
aprint_error_dev(self, "HUAWEI E220 need to re-attach "
"to enable modem function\n");
if (i == 0) {
/* could not get intr for main tty */
sc->sc_ubsa.sc_dying = 1;
goto error;
} else
break;
}
if (uca.bulkin == -1) {
aprint_error_dev(self,
"Could not find data bulk in\n");
sc->sc_ubsa.sc_dying = 1;
goto error;
}
if (uca.bulkout == -1) {
aprint_error_dev(self,
"Could not find data bulk out\n");
sc->sc_ubsa.sc_dying = 1;
goto error;
}
switch (i) {
case 0:
snprintf(comname, sizeof(comname), "modem");
break;
case 1:
snprintf(comname, sizeof(comname), "alt#1");
break;
case 2:
snprintf(comname, sizeof(comname), "alt#2");
break;
default:
snprintf(comname, sizeof(comname), "int#%d", i);
break;
}
uca.portno = i;
/* bulkin, bulkout set above */
uca.ibufsize = UHMODEMIBUFSIZE;
uca.obufsize = UHMODEMOBUFSIZE;
uca.ibufsizepad = UHMODEMIBUFSIZE;
uca.opkthdrlen = 0;
uca.device = dev;
uca.iface = sc->sc_ubsa.sc_iface[i];
uca.methods = &uhmodem_methods;
uca.arg = &sc->sc_ubsa;
uca.info = comname;
DPRINTF(("uhmodem: int#=%d, in = 0x%x, out = 0x%x, intr = 0x%x\n",
i, uca.bulkin, uca.bulkout, sc->sc_ubsa.sc_intr_number));
sc->sc_ubsa.sc_subdevs[i] = config_found_sm_loc(self, "ucombus", NULL,
&uca, ucomprint, ucomsubmatch);
/* issue endpoint halt to each interface */
err = uhmodem_endpointhalt(&sc->sc_ubsa, i);
if (err)
aprint_error("%s: endpointhalt fail\n", __func__);
else
usbd_delay_ms(sc->sc_ubsa.sc_udev, 50);
} /* end of Interface loop */
usbd_add_drv_event(USB_EVENT_DRIVER_ATTACH, sc->sc_ubsa.sc_udev,
USBDEV(sc->sc_ubsa.sc_dev));
USB_ATTACH_SUCCESS_RETURN;
error:
USB_ATTACH_ERROR_RETURN;
}
void
uhmodem_childdet(device_t self, device_t child)
{
int i;
struct uhmodem_softc *sc = device_private(self);
for (i = 0; i < sc->sc_ubsa.sc_numif; i++) {
if (sc->sc_ubsa.sc_subdevs[i] == child)
break;
}
KASSERT(i < sc->sc_ubsa.sc_numif);
sc->sc_ubsa.sc_subdevs[i] = NULL;
}
USB_DETACH(uhmodem)
{
USB_DETACH_START(uhmodem, sc);
int i;
int rv = 0;
DPRINTF(("uhmodem_detach: sc = %p\n", sc));
if (sc->sc_ubsa.sc_intr_pipe != NULL) {
usbd_abort_pipe(sc->sc_ubsa.sc_intr_pipe);
usbd_close_pipe(sc->sc_ubsa.sc_intr_pipe);
free(sc->sc_ubsa.sc_intr_buf, M_USBDEV);
sc->sc_ubsa.sc_intr_pipe = NULL;
}
sc->sc_ubsa.sc_dying = 1;
for (i = 0; i < sc->sc_ubsa.sc_numif; i++) {
if (sc->sc_ubsa.sc_subdevs[i] != NULL)
rv |= config_detach(sc->sc_ubsa.sc_subdevs[i], flags);
}
usbd_add_drv_event(USB_EVENT_DRIVER_DETACH, sc->sc_ubsa.sc_udev,
USBDEV(sc->sc_ubsa.sc_dev));
return (rv);
}
int
uhmodem_activate(device_t self, enum devact act)
{
struct uhmodem_softc *sc = device_private(self);
int rv = 0;
int i;
switch (act) {
case DVACT_ACTIVATE:
return (EOPNOTSUPP);
case DVACT_DEACTIVATE:
for (i = 0; i < sc->sc_ubsa.sc_numif; i++) {
if (sc->sc_ubsa.sc_subdevs[i] != NULL)
rv |= config_deactivate(sc->sc_ubsa.sc_subdevs[i]);
}
sc->sc_ubsa.sc_dying = 1;
break;
}
return (rv);
}
Static int
uhmodem_open(void *addr, int portno)
{
struct ubsa_softc *sc = addr;
usbd_status err;
if (sc->sc_dying)
return (ENXIO);
DPRINTF(("%s: sc = %p\n", __func__, sc));
err = uhmodem_endpointhalt(sc, 0);
if (err)
aprint_error("%s: endpointhalt fail\n", __func__);
else
usbd_delay_ms(sc->sc_udev, 50);
if (sc->sc_devflags & A2502) {
err = a2502_init(sc->sc_udev);
if (err)
aprint_error("%s: a2502init fail\n", __func__);
else
usbd_delay_ms(sc->sc_udev, 50);
}
#if 0 /* currently disabled */
if (sc->sc_devflags & E220) {
err = e220_init(sc->sc_udev);
if (err)
aprint_error("%s: e220init fail\n", __func__);
else
usbd_delay_ms(sc->sc_udev, 50);
}
#endif
if (sc->sc_intr_number != -1 && sc->sc_intr_pipe == NULL) {
sc->sc_intr_buf = malloc(sc->sc_isize, M_USBDEV, M_WAITOK);
/* 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) {
aprint_error_dev(sc->sc_dev,
"cannot open interrupt pipe (addr %d)\n",
sc->sc_intr_number);
return (EIO);
}
}
return (0);
}
/*
* Hauwei E220 needs special request to enable modem function.
* -- DEVICE_REMOTE_WAKEUP ruquest to endpoint 2.
*/
Static usbd_status
e220_modechange_request(usbd_device_handle dev)
{
#define E220_MODE_CHANGE_REQUEST 0x2
usb_device_request_t req;
usbd_status err;
req.bmRequestType = UT_WRITE_DEVICE;
req.bRequest = UR_SET_FEATURE;
USETW(req.wValue, UF_DEVICE_REMOTE_WAKEUP);
USETW(req.wIndex, E220_MODE_CHANGE_REQUEST);
USETW(req.wLength, 0);
DPRINTF(("%s: send e220 mode change request\n", __func__));
err = usbd_do_request(dev, &req, 0);
if (err) {
DPRINTF(("%s: E220 mode change fail\n", __func__));
return (EIO);
}
return (0);
#undef E220_MODE_CHANGE_REQUEST
}
Static usbd_status
uhmodem_endpointhalt(struct ubsa_softc *sc, int iface)
{
usb_device_request_t req;
usb_endpoint_descriptor_t *ed;
usb_interface_descriptor_t *id;
usbd_status err;
int i;
/* Find the endpoints */
id = usbd_get_interface_descriptor(sc->sc_iface[iface]);
for (i = 0; i < id->bNumEndpoints; i++) {
ed = usbd_interface2endpoint_descriptor(sc->sc_iface[iface], i);
if (ed == NULL)
return (EIO);
if (UE_GET_XFERTYPE(ed->bmAttributes) == UE_BULK) {
/* issue ENDPOINT_HALT request */
req.bmRequestType = UT_WRITE_ENDPOINT;
req.bRequest = UR_CLEAR_FEATURE;
USETW(req.wValue, UF_ENDPOINT_HALT);
USETW(req.wIndex, ed->bEndpointAddress);
USETW(req.wLength, 0);
err = usbd_do_request(sc->sc_udev, &req, 0);
if (err) {
DPRINTF(("%s: ENDPOINT_HALT to EP:%d fail\n",
__func__, ed->bEndpointAddress));
return (EIO);
}
}
} /* end of Endpoint loop */
return (0);
}
Static usbd_status
uhmodem_regwrite(usbd_device_handle dev, uint8_t *data, size_t len)
{
usb_device_request_t req;
usbd_status err;
req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
req.bRequest = UHMODEM_REGWRITE;
USETW(req.wValue, 0x0000);
USETW(req.wIndex, 0x0000);
USETW(req.wLength, len);
err = usbd_do_request(dev, &req, data);
if (err)
return err;
return 0;
}
Static usbd_status
uhmodem_regread(usbd_device_handle dev, uint8_t *data, size_t len)
{
usb_device_request_t req;
usbd_status err;
req.bmRequestType = UT_READ_CLASS_INTERFACE;
req.bRequest = UHMODEM_REGREAD;
USETW(req.wValue, 0x0000);
USETW(req.wIndex, 0x0000);
USETW(req.wLength, len);
err = usbd_do_request(dev, &req, data);
if (err)
return err;
return 0;
}
#if 0
Static usbd_status
uhmodem_regsetup(usbd_device_handle dev, uint16_t cmd)
{
usb_device_request_t req;
usbd_status err;
req.bmRequestType = UT_READ_CLASS_INTERFACE;
req.bRequest = UHMODEM_SETUP;
USETW(req.wValue, cmd);
USETW(req.wIndex, 0x0000);
USETW(req.wLength, 0);
err = usbd_do_request(dev, &req, 0);
if (err)
return err;
return 0;
}
#endif
Static usbd_status
a2502_init(usbd_device_handle dev)
{
uint8_t data[8];
static uint8_t init_cmd[] = {0x00, 0xE1, 0x00, 0x00, 0x00, 0x00, 0x08};
#ifdef UHMODEM_DEBUG
int i;
#endif
if (uhmodem_regread(dev, data, 7)) {
DPRINTF(("%s: read fail\n", __func__));
return EIO;
}
#ifdef UHMODEM_DEBUG
printf("%s: readdata: ", __func__);
for (i = 0; i < 7; i++)
printf("0x%x ", data[i]);
#endif
if (uhmodem_regwrite(dev, init_cmd, sizeof(init_cmd)) ) {
DPRINTF(("%s: write fail\n", __func__));
return EIO;
}
if (uhmodem_regread(dev, data, 7)) {
DPRINTF(("%s: read fail\n", __func__));
return EIO;
}
#ifdef UHMODEM_DEBUG
printf("%s: readdata: ", __func__);
printf(" => ");
for (i = 0; i < 7; i++)
printf("0x%x ", data[i]);
printf("\n");
#endif
return 0;
}
#if 0
/*
* Windows device driver send these sequens of USB requests.
* However currently I can't understand what the messege is,
* disable this code when I get more information about it.
*/
Static usbd_status
e220_init(usbd_device_handle dev)
{
uint8_t data[8];
usb_device_request_t req;
int i;
/* vendor specific unknown request */
req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
req.bRequest = 0x02;
USETW(req.wValue, 0x0001);
USETW(req.wIndex, 0x0000);
USETW(req.wLength, 2);
data[0] = 0x0;
data[1] = 0x0;
if (usbd_do_request(dev, &req, data))
goto error;
/* vendor specific unknown sequence */
if(uhmodem_regsetup(dev, 0x1))
goto error;
if (uhmodem_regread(dev, data, 7))
goto error;
data[1] = 0x8;
data[2] = 0x7;
if (uhmodem_regwrite(dev, data, sizeof(data)) )
goto error;
if (uhmodem_regread(dev, data, 7))
goto error;
/* XXX should verify the read data ? */
if (uhmodem_regsetup(dev, 0x3))
goto error;
return (0);
error:
DPRINTF(("%s: E220 init request fail\n", __func__));
return (EIO);
}
#endif