Changeset 2bf8f8c in mainline for uspace/drv/ohci/batch.c

Timestamp:

2011-03-21T13:18:03Z (14 years ago)

Author:

Jan Vesely <jano.vesely@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

d328172

Parents:

be7950e8

Message:

Implement batch_get

File:

• uspace/drv/ohci/batch.c (modified) (3 diffs)

uspace/drv/ohci/batch.c

@@ -39 +39 @@
 
 #include "batch.h"
+#include "utils/malloc32.h"
 
 #define DEFAULT_ERROR_COUNT 3
@@ -48 +49 @@
     usb_speed_t speed,
                 char *buffer,
-                size_t size,
+                size_t buffer_size,
                 char *setup_buffer,
                 size_t setup_size,
@@ -57 +58 @@
                 )
 {
-        return NULL;
+#define CHECK_NULL_DISPOSE_RETURN(ptr, message...) \
+        if (ptr == NULL) { \
+                usb_log_error(message); \
+                if (instance) { \
+                        batch_dispose(instance); \
+                } \
+                return NULL; \
+        } else (void)0
+
+        batch_t *instance = malloc(sizeof(batch_t));
+        CHECK_NULL_DISPOSE_RETURN(instance,
+            "Failed to allocate batch instance.\n");
+        batch_init(instance, target, transfer_type, speed, max_packet_size,
+            buffer, NULL, buffer_size, NULL, setup_size, func_in,
+            func_out, arg, fun, NULL);
+
+        if (buffer_size > 0) {
+                instance->transport_buffer = malloc32(buffer_size);
+                CHECK_NULL_DISPOSE_RETURN(instance->transport_buffer,
+                    "Failed to allocate device accessible buffer.\n");
+        }
+
+        if (setup_size > 0) {
+                instance->setup_buffer = malloc32(setup_size);
+                CHECK_NULL_DISPOSE_RETURN(instance->setup_buffer,
+                    "Failed to allocate device accessible setup buffer.\n");
+                memcpy(instance->setup_buffer, setup_buffer, setup_size);
+        }
+
+
+        return instance;
 }
 /*----------------------------------------------------------------------------*/
 void batch_dispose(batch_t *instance)
 {
+        assert(instance);
 }
 /*----------------------------------------------------------------------------*/
 void batch_control_write(batch_t *instance)
 {
+        assert(instance);
 }
 /*----------------------------------------------------------------------------*/
 void batch_control_read(batch_t *instance)
 {
+        assert(instance);
 }
 /*----------------------------------------------------------------------------*/
 void batch_interrupt_in(batch_t *instance)
 {
+        assert(instance);
 }
 /*----------------------------------------------------------------------------*/
 void batch_interrupt_out(batch_t *instance)
 {
+        assert(instance);
 }
 /*----------------------------------------------------------------------------*/
 void batch_bulk_in(batch_t *instance)
 {
+        assert(instance);
 }
 /*----------------------------------------------------------------------------*/
 void batch_bulk_out(batch_t *instance)
 {
+        assert(instance);
 }
 /**