| 1 | #include <errno.h>
|
|---|
| 2 | #include <mem.h>
|
|---|
| 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);
|
|---|
| 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;
|
|---|
| 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;
|
|---|
| 29 | instance->arg = arg;
|
|---|
| 30 | return EOK;
|
|---|
| 31 | }
|
|---|
| 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 */
|
|---|
| 39 | if (instance->new_buffer &&
|
|---|
| 40 | (instance->new_buffer != instance->old_buffer)) {
|
|---|
| 41 | memcpy(instance->old_buffer, instance->new_buffer, instance->buffer_size);
|
|---|
| 42 | free32(instance->new_buffer);
|
|---|
| 43 | instance->new_buffer = NULL;
|
|---|
| 44 | }
|
|---|
| 45 |
|
|---|
| 46 | if (instance->callback_in) {
|
|---|
| 47 | assert(instance->callback_out == NULL);
|
|---|
| 48 | uhci_print_verbose("Callback in: %p %x %d.\n",
|
|---|
| 49 | instance->callback_in, outcome, act_size);
|
|---|
| 50 | instance->callback_in(
|
|---|
| 51 | instance->dev, outcome, act_size, instance->arg);
|
|---|
| 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);
|
|---|
| 59 | }
|
|---|
| 60 | }
|
|---|
