Changeset 3a85a2b in mainline

Timestamp:

2011-04-15T07:46:50Z (14 years ago)

Author:

Matus Dekanek <smekideki@…>

Branches:

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

Children:

cd5b878

Parents:

e05d6c3

Message:

ohci root hub, interrupts

File:

• uspace/drv/ohci/root_hub.c (modified) (5 diffs)

uspace/drv/ohci/root_hub.c

@@ -198 +198 @@
 static int process_ctrl_request(rh_t *instance, usb_transfer_batch_t *request);
 
-
+static int process_interrupt(rh_t *instance, usb_transfer_batch_t * request,
+    void * change_buffer, size_t buffe_size);
+
+static bool is_zeros(void * buffer, size_t size);
 
 
@@ -213 +216 @@
         // set port power mode to no-power-switching
         instance->registers->rh_desc_a |= RHDA_NPS_FLAG;
-
+        instance->unfinished_interrupt_transfer = NULL;
         usb_log_info("OHCI root hub with %d ports.\n", instance->port_count);
         return EOK;
@@ -236 +239 @@
                 usb_log_info("Root hub got INTERRUPT packet\n");
                 void * buffer;
+                size_t buffer_size;
                 create_interrupt_mask(instance, &buffer,
-                        &(request->transfered_size));
-                memcpy(request->data_buffer, buffer,
-                        request->transfered_size);
+                        &buffer_size);
+                if(is_zeros(buffer,buffer_size)){
+                        usb_log_debug("no changes..");
+                        instance->unfinished_interrupt_transfer=
+                            request;
+                        //will be finished later
+                }else{
+                        usb_log_debug("processing changes..");
+                        process_interrupt(instance, request,
+                            buffer, buffer_size);
+                }
+                free(buffer);
                 opResult = EOK;
         } else {
                 opResult = EINVAL;
-        }
-        usb_transfer_batch_finish_error(request, opResult);
+                usb_transfer_batch_finish_error(request, opResult);
+        }
         return EOK;
 }
@@ -252 +265 @@
 
 void rh_interrupt(rh_t *instance) {
-        usb_log_info("Whoa whoa wait, I`m not supposed to receive any "
-                "interrupts, am I?\n");
-        /* TODO: implement? */
+        //usb_log_info("Whoa whoa wait, I`m not supposed to receive any "
+        //      "interrupts, am I?\n");
+        if(!instance->unfinished_interrupt_transfer){
+                return;
+        }
+        size_t size;
+        void * buffer;
+        create_interrupt_mask(instance, &buffer,
+                        &size);
+        process_interrupt(instance,instance->unfinished_interrupt_transfer,
+            buffer,size);
+        free(buffer);
 }
 /*----------------------------------------------------------------------------*/
@@ -859 +881 @@
         return opResult;
 }
+/*----------------------------------------------------------------------------*/
+
+/**
+ * process hanging interrupt request
+ *
+ * If an interrupt transfer has been received and there was no change,
+ * the driver stores the transfer information and waits for change to occcur.
+ * This routine is called when that happens and it finalizes the interrupt
+ * transfer.
+ *
+ * @param instance hub instance
+ * @param request batch request to be processed
+ * @param change_buffer chages on hub
+ * @param buffer_size size of change buffer
+ *
+ * @return
+ */
+static int process_interrupt(rh_t *instance, usb_transfer_batch_t * request,
+    void * change_buffer, size_t buffe_size){
+        create_interrupt_mask(instance, &change_buffer,
+            &(request->transfered_size));
+        memcpy(request->data_buffer, change_buffer,request->transfered_size);
+        instance->unfinished_interrupt_transfer = NULL;
+        usb_transfer_batch_finish_error(request, EOK);
+        return EOK;
+}
+
+/*----------------------------------------------------------------------------*/
+
+/**
+ * return whether the buffer is full of zeros
+ *
+ * Convenience function.
+ * @param buffer
+ * @param size
+ * @return
+ */
+static bool is_zeros(void * buffer, size_t size){
+        if(!buffer) return true;
+        if(!size) return true;
+        size_t i;
+        for(i=0;i<size;++i){
+                if(((char*)buffer)[i])
+                        return false;
+        }
+        return true;
+}
 
 /**