Changeset 70a71e5 in mainline

Timestamp:

2011-04-01T13:18:42Z (14 years ago)

Author:

Matej Klonfar <maklf@…>

Branches:

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

Children:

7787dd81, bda06a3

Parents:

ad7bb42

Message:

Output API fix

Location:

uspace

Files:

• drv/usbkbd/kbddev.c (modified) (2 diffs)
• lib/usb/src/hidparser.c (modified) (9 diffs)

uspace/drv/usbkbd/kbddev.c

@@ -276 +276 @@
 //              leds |= USB_HID_LED_NUM_LOCK;
         }
+        else {
+            kbd_dev->led_data[i++] = 0;
+        }
         
         if ((kbd_dev->mods & KM_CAPS_LOCK) && (i < kbd_dev->led_output_size)) {
                 kbd_dev->led_data[i++] = USB_HID_LED_CAPS_LOCK;
 //              leds |= USB_HID_LED_CAPS_LOCK;
+        }
+        else {
+            kbd_dev->led_data[i++] = 0;
         }
         
@@ -286 +292 @@
                 kbd_dev->led_data[i++] = USB_HID_LED_SCROLL_LOCK;
 //              leds |= USB_HID_LED_SCROLL_LOCK;
+        }
+        else {
+            kbd_dev->led_data[i++] = 0;
         }
         

uspace/lib/usb/src/hidparser.c

@@ -1200 +1200 @@
         }
 
+        usb_log_debug("OUTPUT BUFFER: %s\n", usb_debug_str_buffer(buffer,size, 0));
+        usb_log_debug("OUTPUT DATA[0]: %d, DATA[1]: %d, DATA[2]: %d\n", data[0], data[1], data[2]);
+
         item = parser->output.next;     
         while(item != &parser->output) {
@@ -1208 +1211 @@
                         if(idx >= data_size) {
                                 break;
-                        }
-
-                        // translate data
-                        if(USB_HID_ITEM_FLAG_CONSTANT(report_item->item_flags)) {
-                                value = report_item->logical_minimum;
-                        }
-                        else {
-                                //variable item
-                                value = usb_hid_translate_data_reverse(report_item, data[idx]);
-                                idx++;
                         }
 
@@ -1224 +1217 @@
                                         
 //                              // variable item
+                                value = usb_hid_translate_data_reverse(report_item, data[idx++]);
                                 offset = report_item->offset + (i * report_item->size);
                                 length = report_item->size;
@@ -1229 +1223 @@
                         else {
                                 //bitmap
+                                value += usb_hid_translate_data_reverse(report_item, data[idx++]);
                                 offset = report_item->offset;
                                 length = report_item->size * report_item->count;
@@ -1243 +1238 @@
                                 value = value << shift;                                                 
                                 value = value & (((1 << length)-1) << shift);
-                                buffer[offset/8] = buffer[offset/8] | value;
+                                
+                                uint8_t mask = 0;
+                                mask = 0xff - (((1 << length) - 1) << shift);
+                                buffer[offset/8] = (buffer[offset/8] & mask) | value;
                         }
                         else {
@@ -1253 +1251 @@
                                 tmp_value = tmp_value << (offset%8);
 
-                                buffer[offset/8] = buffer[offset/8] | tmp_value;
+                                uint8_t mask = 0;
+                                mask = ~(((1 << (8-(offset%8)))-1) << (offset%8));
+                                buffer[offset/8] = (buffer[offset/8] & mask) | tmp_value;
 
                                 // a ted druhej -- hornich length-x bitu
@@ -1259 +1259 @@
                                 value = value & ((1 << (length - (8 - (offset % 8)))) - 1);
                                 
-                                buffer[(offset+length-1)/8] = buffer[(offset+length-1)/8] | value;
+                                mask = ((1 << (length - (8 - (offset % 8)))) - 1);
+                                buffer[(offset+length-1)/8] = (buffer[(offset+length-1)/8] & mask) | value;
                         }
 
@@ -1267 +1268 @@
         }
 
+        usb_log_debug("OUTPUT BUFFER: %s\n", usb_debug_str_buffer(buffer,size, 0));
 
         return EOK;
@@ -1281 +1283 @@
         int ret=0;
         int resolution;
+
+        if(USB_HID_ITEM_FLAG_CONSTANT(item->item_flags)) {
+                ret = item->logical_minimum;
+        }
 
         if((USB_HID_ITEM_FLAG_VARIABLE(item->item_flags) == 0)) {