[89a0485a] | 1 | #include <errno.h>
|
---|
[db7ed07] | 2 | #include <mem.h>
|
---|
[89a0485a] | 3 |
|
---|
| 4 | #include "callback.h"
|
---|
| 5 | int callback_init(callback_t *instance, device_t *dev,
|
---|
| 6 | void *buffer, size_t size, usbhc_iface_transfer_in_callback_t func_in,
|
---|
| 7 | usbhc_iface_transfer_out_callback_t func_out, void *arg)
|
---|
| 8 | {
|
---|
| 9 | assert(instance);
|
---|
| 10 | assert(func_in == NULL || func_out == NULL);
|
---|
[44d8853] | 11 | if (size > 0) {
|
---|
| 12 | instance->new_buffer = malloc32(size);
|
---|
| 13 | if (!instance->new_buffer) {
|
---|
| 14 | uhci_print_error("Failed to allocate device acessible buffer.\n");
|
---|
| 15 | return ENOMEM;
|
---|
| 16 | }
|
---|
| 17 | if (func_out)
|
---|
| 18 | memcpy(instance->new_buffer, buffer, size);
|
---|
| 19 | } else {
|
---|
| 20 | instance->new_buffer = NULL;
|
---|
[89a0485a] | 21 | }
|
---|
| 22 |
|
---|
| 23 |
|
---|
| 24 | instance->callback_out = func_out;
|
---|
| 25 | instance->callback_in = func_in;
|
---|
| 26 | instance->old_buffer = buffer;
|
---|
| 27 | instance->buffer_size = size;
|
---|
| 28 | instance->dev = dev;
|
---|
[0b68b7c] | 29 | instance->arg = arg;
|
---|
[89a0485a] | 30 | return EOK;
|
---|
| 31 | }
|
---|
[db7ed07] | 32 | /*----------------------------------------------------------------------------*/
|
---|
| 33 | void callback_run(
|
---|
| 34 | callback_t *instance, usb_transaction_outcome_t outcome, size_t act_size)
|
---|
| 35 | {
|
---|
| 36 | assert(instance);
|
---|
| 37 |
|
---|
| 38 | /* update the old buffer */
|
---|
[d956aa5] | 39 | if (instance->new_buffer &&
|
---|
| 40 | (instance->new_buffer != instance->old_buffer)) {
|
---|
| 41 | memcpy(instance->old_buffer, instance->new_buffer, instance->buffer_size);
|
---|
[de0e6b3] | 42 | free32(instance->new_buffer);
|
---|
[db7ed07] | 43 | instance->new_buffer = NULL;
|
---|
| 44 | }
|
---|
| 45 |
|
---|
| 46 | if (instance->callback_in) {
|
---|
| 47 | assert(instance->callback_out == NULL);
|
---|
[0b68b7c] | 48 | uhci_print_verbose("Callback in: %p %x %d.\n",
|
---|
| 49 | instance->callback_in, outcome, act_size);
|
---|
[db7ed07] | 50 | instance->callback_in(
|
---|
| 51 | instance->dev, act_size, outcome, instance->arg);
|
---|
[0b68b7c] | 52 | } else {
|
---|
| 53 | assert(instance->callback_out);
|
---|
| 54 | assert(instance->callback_in == NULL);
|
---|
| 55 | uhci_print_verbose("Callback out: %p %p %x %p .\n",
|
---|
| 56 | instance->callback_out, instance->dev, outcome, instance->arg);
|
---|
| 57 | instance->callback_out(
|
---|
| 58 | instance->dev, outcome, instance->arg);
|
---|
[db7ed07] | 59 | }
|
---|
| 60 | }
|
---|