EMTime/libopencm3
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Allow more than one usbd_register_set_config_callback

Browse Source 
In a composite device if one want to separate code
for each interface, usbd_register_set_config_callback
can now register more than one callback.

Signed-off-by: Franck Jullien <franck.jullien@gmail.com>
This commit is contained in:
Franck Jullien
2014-07-11 17:20:47 +02:00
committed by Frantisek Burian
parent 806ebb18fa
commit d6bad27735
2 changed files with 21 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

21
lib/usb/usb_standard.c
View File

@@ -39,11 +39,21 @@ LGPL License Terms @ref lgpl_license
#include <libopencm3/usb/usbd.h>
#include "usb_private.h"
void usbd_register_set_config_callback(usbd_device *usbd_dev,
int usbd_register_set_config_callback(usbd_device *usbd_dev,
void (*callback)(usbd_device *usbd_dev,
uint16_t wValue))
{
usbd_dev->user_callback_set_config = callback;
int i;
for (i = 0; i < MAX_USER_SET_CONFIG_CALLBACK; i++) {
if (usbd_dev->user_callback_set_config[i])
continue;
usbd_dev->user_callback_set_config[i] = callback;
return 0;
}
return -1;
}
static uint16_t build_config_descriptor(usbd_device *usbd_dev,
@@ -244,7 +254,12 @@ static int usb_standard_set_configuration(usbd_device *usbd_dev,
usbd_dev->user_control_callback[i].cb = NULL;
}
usbd_dev->user_callback_set_config(usbd_dev, req->wValue);
for (i = 0; i < MAX_USER_SET_CONFIG_CALLBACK; i++) {
if (usbd_dev->user_callback_set_config[i]) {
usbd_dev->user_callback_set_config[i](usbd_dev,
req->wValue);
}
}
}
return 1;