minix/lib/libusb/usb.c
Ben Gras 2d2a1a077d panic: declare as printf-style-checked
. and related fixes

Change-Id: I5131ac57dc53d8aec8d421a34c5ceea383404d7a
2013-05-31 13:35:25 +00:00

225 lines
5.3 KiB
C

#include <minix/config.h>
#include <minix/const.h>
#include <minix/usb.h>
#include <minix/com.h>
#include <minix/safecopies.h>
#include <minix/sysutil.h>
#include <minix/ds.h>
#include <stdlib.h>
#include <errno.h>
#include <string.h>
static struct usb_urb * pending_urbs = NULL;
static endpoint_t hcd_ep;
static void _usb_urb_complete(struct usb_driver *ud, long urb_id);
/*****************************************************************************
* usb_send_urb *
****************************************************************************/
int usb_send_urb(struct usb_urb* urb)
{
message msg;
int res;
cp_grant_id_t gid;
if (urb == NULL) {
return EINVAL;
}
if (hcd_ep == 0) {
return EINVAL;
}
/* setup grant */
gid = cpf_grant_direct(hcd_ep,(vir_bytes) &urb->dev_id,
urb->urb_size - sizeof(void*),CPF_WRITE|CPF_READ);
if (gid == -1) {
printf("usb_send_urb: grant failed: "
"cpf_grant_direct(%d,%p,%d)\n", hcd_ep, urb, urb->urb_size);
return EINVAL;
}
urb->gid = gid;
/* prepare message */
msg.m_type = USB_RQ_SEND_URB;
msg.USB_GRANT_ID = gid;
msg.USB_GRANT_SIZE = urb->urb_size-sizeof(void*);
/* send message */
res = sendrec(hcd_ep, &msg);
if (res != 0) {
panic("usb_send_urb: could not talk to hcd: %d", res);
}
if (msg.m_type != USB_REPLY) {
panic("usb_send_urb: got illegal response from hcd: %d", msg.m_type);
}
if (msg.USB_RESULT != 0) {
panic("usb_send_urb: hcd could not enqueue URB: %ld", msg.USB_RESULT);
}
/* everything ok, add urb to pending_urbs */
urb->urb_id = msg.USB_URB_ID;
urb->next = pending_urbs;
pending_urbs = urb;
/* done. */
/* (The HCD will send us a message when the URB is completed.) */
return res;
}
/*****************************************************************************
* usb_cancle_urb *
****************************************************************************/
int usb_cancle_urb(struct usb_urb* urb)
{
int res;
message msg;
if (urb == NULL) {
panic("usb_send_urb: urb == NULL!");
}
if (urb->urb_id == USB_INVALID_URB_ID) {
return EINVAL;
}
/* prepare message */
msg.m_type = USB_RQ_CANCEL_URB;
msg.USB_URB_ID = urb->urb_id;
/* send message */
res = sendrec(hcd_ep, &msg);
if (res != 0) {
panic("usb_cancle_urb: could not talk to hcd: %d", res);
}
if (msg.m_type != USB_REPLY) {
panic("usb_cancle_urb: got illegal response from hcd: %d", msg.m_type);
}
if (msg.USB_RESULT != 0) {
panic("usb_cancle_urb: got illegal response from hcd: %d", msg.m_type);
}
res = msg.USB_RESULT;
/* done. */
return res;
}
/*****************************************************************************
* usb_init *
****************************************************************************/
int usb_init(char *name)
{
int res;
message msg;
/* get the endpoint of the HCD */
res = ds_retrieve_label_endpt("usbd", &hcd_ep);
if (res != 0) {
panic("usb_init: ds_retrieve_label_endpt failed for 'usb': %d", res);
}
msg.m_type = USB_RQ_INIT;
strncpy(msg.USB_RB_INIT_NAME, name, M3_LONG_STRING);
res = sendrec(hcd_ep, &msg);
if (res != 0) {
panic("usb_init: can't talk to USB: %d", res);
}
if (msg.m_type != USB_REPLY) {
panic("usb_init: bad reply from USB: %d", msg.m_type);
}
if (msg.USB_RESULT != 0 ) {
panic("usb_init: init failed: %ld", msg.USB_RESULT);
}
return 0;
}
/*****************************************************************************
* _usb_urb_complete *
****************************************************************************/
static void _usb_urb_complete(struct usb_driver *ud, long urb_id)
{
/* find the corresponding URB in the urb_pending list. */
struct usb_urb * urb = NULL;
if (pending_urbs != NULL) {
if (pending_urbs->urb_id == urb_id) {
urb = pending_urbs;
pending_urbs = urb->next;
} else {
struct usb_urb *u = pending_urbs;
while (u->next) {
if (u->next->urb_id == urb_id) {
urb = u->next;
u->next = u->next->next;
urb->next = NULL;
break;
}
u = u->next;
}
}
}
/* Did we find a URB? */
if (urb != NULL) {
/* revoke grant */
cpf_revoke(urb->gid);
/* call completion handler */
#if 0
dump_urb(urb);
#endif
ud->urb_completion(urb);
} else {
printf("WARN: _usb_urb_complete: did not find URB with ID %ld", urb_id);
}
}
/*****************************************************************************
* usb_handle_msg *
****************************************************************************/
int usb_handle_msg(struct usb_driver *ud, message *msg)
{
/*
* we expect kind of messages:
* - new usb device
* - removed device
* - URB completed
*
* NOTE: the hcd driver doesn't expect replies for these messages.
*/
if (!ud) {
return -1;
}
switch(msg->m_type) {
case USB_COMPLETE_URB:
_usb_urb_complete(ud, msg->USB_URB_ID);
return 0;
case USB_ANNOUCE_DEV:
ud->connect_device(msg->USB_DEV_ID, msg->USB_INTERFACES);
return 0;
case USB_WITHDRAW_DEV:
ud->disconnect_device(msg->USB_DEV_ID);
return 0;
default:
panic("usb_handle_msg: bogus message from USB");
}
}