minix3/lib/libdevman/usb.c

302 lines
8.7 KiB
C
Raw Permalink Normal View History

2020-02-21 00:59:27 +05:30
#include <errno.h>
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <minix/config.h>
#include <minix/const.h>
#include <minix/devman.h>
#include <minix/usb.h>
#include <minix/sysutil.h>
#include "local.h"
#define CHECKOUTOFMEM(ptr) if(ptr == NULL) \
panic("Out of memory! (%s, line %d)", \
__FILE__, __LINE__)
static int (*bind_cb) (struct devman_usb_bind_cb_data *data, endpoint_t ep);
static int (*unbind_cb) (struct devman_usb_bind_cb_data *data, endpoint_t ep);
/****************************************************************************
* devman_usb_add_attr *
***************************************************************************/
static void
devman_usb_add_attr
(struct devman_dev *dev, char *name, char *data)
{
struct devman_static_attribute *attr = (struct devman_static_attribute *)
malloc(sizeof(struct devman_static_attribute));
CHECKOUTOFMEM(attr);
attr->name = malloc((strlen(name)+1)*sizeof(char));
memcpy(attr->name, name, (strlen(name)+1));
attr->data = malloc((strlen(data)+1)*sizeof(char));
memcpy(attr->data, data, (strlen(data)+1));
TAILQ_INSERT_TAIL(&dev->attrs, attr, list);
}
/****************************************************************************
* add_device_attributes *
***************************************************************************/
static void
add_device_attributes
(struct devman_usb_dev *udev)
{
int ret;
char data[32];
ret = sprintf(data,"0x%02x",udev->desc->bDeviceClass);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(udev->dev, "bDeviceClass", data);
ret = sprintf(data,"0x%02x",udev->desc->bDeviceSubClass);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(udev->dev, "bDeviceSubClass", data);
ret = sprintf(data,"0x%02x",udev->desc->bDeviceProtocol);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(udev->dev, "bDeviceProtocol", data);
ret = sprintf(data,"0x%04x",UGETW(udev->desc->idVendor));
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(udev->dev, "idVendor", data);
ret = sprintf(data,"0x%04x",UGETW(udev->desc->idProduct));
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(udev->dev, "idProduct", data);
if (udev->product)
devman_usb_add_attr(udev->dev, "Product", udev->product);
if (udev->manufacturer)
devman_usb_add_attr(udev->dev, "Manufacturer", udev->manufacturer);
if (udev->serial)
devman_usb_add_attr(udev->dev, "SerialNumber", udev->serial);
devman_usb_add_attr(udev->dev, "dev_type", "USB_DEV");
}
/****************************************************************************
* add_interface_attributes *
***************************************************************************/
static void
add_interface_attributes
(struct devman_usb_interface *intf)
{
int ret;
char data[32];
ret = sprintf(data,"0x%02x",intf->desc->bInterfaceNumber);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(intf->dev, "bInterfaceNumber", data);
ret = sprintf(data,"0x%02x",intf->desc->bAlternateSetting);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(intf->dev, "bAlternateSetting", data);
ret = sprintf(data,"0x%02x",intf->desc->bNumEndpoints);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(intf->dev, "bNumEndpoints", data);
ret = sprintf(data,"0x%02x",intf->desc->bInterfaceClass);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(intf->dev, "bInterfaceClass", data);
ret = sprintf(data,"0x%02x",intf->desc->bInterfaceSubClass);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(intf->dev, "bInterfaceSubClass", data);
ret = sprintf(data,"0x%02x",intf->desc->bInterfaceProtocol);
if (ret < 0) {
panic("add_device_attributes: sprintf failed");
}
devman_usb_add_attr(intf->dev, "bInterfaceProtocol", data);
devman_usb_add_attr(intf->dev, "dev_type", "USB_INTF");
}
/****************************************************************************
* devman_usb_device_new *
***************************************************************************/
struct devman_usb_dev*
devman_usb_device_new
(int dev_id)
{
struct devman_usb_dev *udev = NULL;
struct devman_dev * dev = NULL;
udev = (struct devman_usb_dev *) malloc(sizeof(struct devman_usb_dev));
CHECKOUTOFMEM(udev);
/* allocate device */
dev = (struct devman_dev *) malloc(sizeof(struct devman_dev));
CHECKOUTOFMEM(dev);
udev->dev_id = dev_id;
udev->dev = dev;
dev->parent_dev_id = 0; /* For now add it directly to the root dev */
snprintf(dev->name, DEVMAN_DEV_NAME_LEN, "USB%d", dev_id);
TAILQ_INIT(&dev->attrs);
return udev;
}
/****************************************************************************
* devman_usb_device_delete *
***************************************************************************/
void devman_usb_device_delete(struct devman_usb_dev *udev)
{
int i;
struct devman_static_attribute *attr,*temp;
for (i=0; i < udev->intf_count; i++) {
TAILQ_FOREACH_SAFE(attr, &udev->interfaces[i].dev->attrs, list, temp)
{
free(attr->name);
free(attr->data);
free(attr);
}
free(udev->interfaces[i].dev);
}
TAILQ_FOREACH_SAFE(attr, &udev->dev->attrs, list, temp) {
free(attr->name);
free(attr->data);
free(attr);
}
free(udev->dev);
free(udev);
}
static int devman_usb_bind_cb(void *data, endpoint_t ep) {
if (bind_cb) {
return bind_cb((struct devman_usb_bind_cb_data *) data, ep);
} else {
return ENODEV;
}
}
static int devman_usb_unbind_cb(void *data, endpoint_t ep) {
if (unbind_cb) {
return unbind_cb((struct devman_usb_bind_cb_data *) data, ep);
} else {
return ENODEV;
}
}
/****************************************************************************
* devman_usb_device_add *
***************************************************************************/
int devman_usb_device_add(struct devman_usb_dev *dev)
{
int i,res = 0;
add_device_attributes(dev);
/* add the USB device */
dev->cb_data.dev_id = dev->dev_id;
dev->cb_data.interface = -1;
dev->dev->bind_cb = devman_usb_bind_cb;
dev->dev->unbind_cb = devman_usb_unbind_cb;
dev->dev->data = &dev->cb_data;
res = devman_add_device(dev->dev);
if (res != 0) {
panic("devman_usb_device_add(): devman_add_device failed.");
}
/* add the USB interfaces */
for (i=0; i < dev->intf_count; i++) {
/* prepare */
dev->interfaces[i].dev =
(struct devman_dev *) malloc(sizeof(struct devman_dev));
CHECKOUTOFMEM(dev->interfaces[i].dev);
TAILQ_INIT(&dev->interfaces[i].dev->attrs);
snprintf(dev->interfaces[i].dev->name, DEVMAN_DEV_NAME_LEN,
"intf%d", i);
add_interface_attributes(&dev->interfaces[i]);
dev->interfaces[i].dev->parent_dev_id = dev->dev->dev_id;
dev->interfaces[i].cb_data.dev_id = dev->dev_id;
dev->interfaces[i].cb_data.interface =
dev->interfaces[i].desc->bInterfaceNumber;
dev->interfaces[i].dev->bind_cb = devman_usb_bind_cb;
dev->interfaces[i].dev->unbind_cb = devman_usb_unbind_cb;
dev->interfaces[i].dev->data = &dev->interfaces[i].cb_data;
/* add */
res = devman_add_device(dev->interfaces[i].dev);
if (res != 0) {
panic("devman_usb_device_add(): devman_add_device failed.");
}
}
return res;
}
/****************************************************************************
* devman_usb_device_remove *
***************************************************************************/
int devman_usb_device_remove(struct devman_usb_dev *dev)
{
int i, res = 0;
for (i=0; i < dev->intf_count; i++) {
res = devman_del_device(dev->interfaces[i].dev);
if (res != 0) {
panic("devman_usb_device_remove(): devman_del_device failed.");
}
}
res = devman_del_device(dev->dev);
return res;
}
/****************************************************************************
* devman_usb_init *
***************************************************************************/
void devman_usb_init
(int (*_bind_cb) (struct devman_usb_bind_cb_data *data, endpoint_t ep),
int (*_unbind_cb) (struct devman_usb_bind_cb_data *data, endpoint_t ep))
{
bind_cb = _bind_cb;
unbind_cb = _unbind_cb;
}