Changeset dd0c8a0 in mainline for uspace/lib/c/generic/device/hw_res_parsed.c

Timestamp:

2013-09-29T06:56:33Z (12 years ago)

Author:

Beniamino Galvani <b.galvani@…>

Branches:

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

Children:

a9bd960d

Parents:

3deb0155 (diff), 13be2583 (diff)
Note: this is a merge changeset, the changes displayed below correspond to the merge itself.
Use the (diff) links above to see all the changes relative to each parent.

Message:

Merge mainline changes.

File:

• uspace/lib/c/generic/device/hw_res_parsed.c (modified) (8 diffs)

uspace/lib/c/generic/device/hw_res_parsed.c

@@ -38 +38 @@
 #include <errno.h>
 
-static void hw_res_parse_add_irq(hw_res_list_parsed_t *out, hw_resource_t *res,
-    int flags)
+static void hw_res_parse_add_dma_channel(hw_res_list_parsed_t *out,
+    const hw_resource_t *res, int flags)
+{
+        assert(res);
+        assert((res->type == DMA_CHANNEL_8) || (res->type == DMA_CHANNEL_16));
+        
+        const unsigned channel = (res->type == DMA_CHANNEL_8) ?
+            res->res.dma_channel.dma8 : res->res.dma_channel.dma16;
+        const size_t count = out->dma_channels.count;
+        const int keep_duplicit = flags & HW_RES_KEEP_DUPLICIT;
+        
+        if (!keep_duplicit) {
+                for (size_t i = 0; i < count; ++i) {
+                        if (out->dma_channels.channels[i] == channel)
+                                return;
+                }
+        }
+        
+        out->dma_channels.channels[count] = channel;
+        ++out->dma_channels.count;
+}
+
+static void hw_res_parse_add_irq(hw_res_list_parsed_t *out,
+    const hw_resource_t *res, int flags)
 {
         assert(res && (res->type == INTERRUPT));
@@ -58 +80 @@
 }
 
+static uint64_t absolutize(uint64_t addr, bool relative, uint64_t base)
+{
+        if (!relative)
+                return addr;
+        else
+                return addr + base;
+}
+
+static uint64_t relativize(uint64_t addr, bool relative, uint64_t base)
+{
+        if (relative)
+                return addr;
+        else
+                return addr - base;
+}
+
 static void hw_res_parse_add_io_range(hw_res_list_parsed_t *out,
-    hw_resource_t *res, int flags)
-{
+    const pio_window_t *win, const hw_resource_t *res, int flags)
+{
+        endianness_t endianness;
+        uint64_t absolute;
+        uint64_t relative;
+        size_t size;
+
         assert(res && (res->type == IO_RANGE));
         
-        uint64_t address = res->res.io_range.address;
-        endianness_t endianness = res->res.io_range.endianness;
-        size_t size = res->res.io_range.size;
+        absolute = absolutize(res->res.io_range.address,
+            res->res.io_range.relative, win->io.base);
+        relative = relativize(res->res.io_range.address,
+            res->res.io_range.relative, win->io.base);
+        size = res->res.io_range.size;
+        endianness = res->res.io_range.endianness;
         
         if ((size == 0) && (!(flags & HW_RES_KEEP_ZERO_AREA)))
@@ -75 +121 @@
         if (!keep_duplicit) {
                 for (size_t i = 0; i < count; i++) {
-                        uint64_t s_address = out->io_ranges.ranges[i].address;
-                        size_t s_size = out->io_ranges.ranges[i].size;
+                        uint64_t s_address;
+                        size_t s_size;
+
+                        s_address = RNGABS(out->io_ranges.ranges[i]);
+                        s_size = RNGSZ(out->io_ranges.ranges[i]);
                         
-                        if ((address == s_address) && (size == s_size))
-                                return;
-                }
-        }
-        
-        out->io_ranges.ranges[count].address = address;
+                        if ((absolute == s_address) && (size == s_size))
+                                return;
+                }
+        }
+        
+        RNGABS(out->io_ranges.ranges[count]) = absolute;
+        RNGREL(out->io_ranges.ranges[count]) = relative;
+        RNGSZ(out->io_ranges.ranges[count]) = size;
         out->io_ranges.ranges[count].endianness = endianness;
-        out->io_ranges.ranges[count].size = size;
         out->io_ranges.count++;
 }
 
 static void hw_res_parse_add_mem_range(hw_res_list_parsed_t *out,
-    hw_resource_t *res, int flags)
-{
+    const pio_window_t *win, const hw_resource_t *res, int flags)
+{
+        endianness_t endianness;
+        uint64_t absolute;
+        uint64_t relative;
+        size_t size;
+        
         assert(res && (res->type == MEM_RANGE));
         
-        uint64_t address = res->res.mem_range.address;
-        endianness_t endianness = res->res.mem_range.endianness;
-        size_t size = res->res.mem_range.size;
+        absolute = absolutize(res->res.mem_range.address,
+            res->res.mem_range.relative, win->mem.base);
+        relative = relativize(res->res.mem_range.address,
+            res->res.mem_range.relative, win->mem.base);
+        size = res->res.mem_range.size;
+        endianness = res->res.mem_range.endianness;
         
         if ((size == 0) && (!(flags & HW_RES_KEEP_ZERO_AREA)))
@@ -106 +164 @@
         if (!keep_duplicit) {
                 for (size_t i = 0; i < count; ++i) {
-                        uint64_t s_address = out->mem_ranges.ranges[i].address;
-                        size_t s_size = out->mem_ranges.ranges[i].size;
+                        uint64_t s_address;
+                        size_t s_size;
+
+                        s_address = RNGABS(out->mem_ranges.ranges[i]);;
+                        s_size = RNGSZ(out->mem_ranges.ranges[i]);
                         
-                        if ((address == s_address) && (size == s_size))
-                                return;
-                }
-        }
-        
-        out->mem_ranges.ranges[count].address = address;
+                        if ((absolute == s_address) && (size == s_size))
+                                return;
+                }
+        }
+        
+        RNGABS(out->mem_ranges.ranges[count]) = absolute;
+        RNGREL(out->mem_ranges.ranges[count]) = relative;
+        RNGSZ(out->mem_ranges.ranges[count]) = size;
         out->mem_ranges.ranges[count].endianness = endianness;
-        out->mem_ranges.ranges[count].size = size;
         out->mem_ranges.count++;
 }
@@ -122 +184 @@
 /** Parse list of hardware resources
  *
- * @param      hw_resources Original structure resource
- * @param[out] out          Output parsed resources
- * @param      flags        Flags of the parsing.
- *                          HW_RES_KEEP_ZERO_AREA for keeping
- *                          zero-size areas, HW_RES_KEEP_DUPLICITIES
- *                          for keep duplicit areas
+ * @param      win          PIO window.
+ * @param      res          Original structure resource.
+ * @param[out] out          Output parsed resources.
+ * @param      flags        Flags of the parsing:
+ *                          HW_RES_KEEP_ZERO_AREA for keeping zero-size areas,
+ *                          HW_RES_KEEP_DUPLICITIES to keep duplicit areas.
  *
  * @return EOK if succeed, error code otherwise.
  *
  */
-int hw_res_list_parse(hw_resource_list_t *hw_resources,
-    hw_res_list_parsed_t *out, int flags)
-{
-        if ((!hw_resources) || (!out))
+int hw_res_list_parse(const pio_window_t *win,
+    const hw_resource_list_t *res, hw_res_list_parsed_t *out, int flags)
+{
+        if (!res || !out)
                 return EINVAL;
         
-        size_t res_count = hw_resources->count;
+        size_t res_count = res->count;
         hw_res_list_parsed_clean(out);
         
-        out->irqs.irqs = malloc(res_count * sizeof(int));
-        out->io_ranges.ranges = malloc(res_count * sizeof(io_range_t));
-        out->mem_ranges.ranges = malloc(res_count * sizeof(mem_range_t));
+        out->irqs.irqs = calloc(res_count, sizeof(int));
+        out->dma_channels.channels = calloc(res_count, sizeof(int));
+        out->io_ranges.ranges = calloc(res_count, sizeof(io_range_t));
+        out->mem_ranges.ranges = calloc(res_count, sizeof(mem_range_t));
+        if (!out->irqs.irqs || !out->dma_channels.channels ||
+            !out->io_ranges.ranges || !out->mem_ranges.ranges) {
+                hw_res_list_parsed_clean(out);
+                return ENOMEM;
+        }
         
         for (size_t i = 0; i < res_count; ++i) {
-                hw_resource_t *resource = &(hw_resources->resources[i]);
+                const hw_resource_t *resource = &res->resources[i];
                 
                 switch (resource->type) {
@@ -153 +221 @@
                         break;
                 case IO_RANGE:
-                        hw_res_parse_add_io_range(out, resource, flags);
+                        hw_res_parse_add_io_range(out, win, resource, flags);
                         break;
                 case MEM_RANGE:
-                        hw_res_parse_add_mem_range(out, resource, flags);
+                        hw_res_parse_add_mem_range(out, win, resource, flags);
+                        break;
+                case DMA_CHANNEL_8:
+                case DMA_CHANNEL_16:
+                        hw_res_parse_add_dma_channel(out, resource, flags);
                         break;
                 default:
+                        hw_res_list_parsed_clean(out);
                         return EINVAL;
                 }
@@ -183 +256 @@
     hw_res_list_parsed_t *hw_res_parsed, int flags)
 {
+        pio_window_t pio_window;
+        int rc;
+
         if (!hw_res_parsed)
                 return EBADMEM;
@@ -188 +264 @@
         hw_resource_list_t hw_resources;
         hw_res_list_parsed_clean(hw_res_parsed);
-        bzero(&hw_resources, sizeof(hw_resource_list_t));
-        
-        int rc = hw_res_get_resource_list(sess, &hw_resources);
+        memset(&hw_resources, 0, sizeof(hw_resource_list_t));
+
+        rc = pio_window_get(sess, &pio_window);
+        if (rc != EOK)
+                return rc; 
+        
+        rc = hw_res_get_resource_list(sess, &hw_resources);
         if (rc != EOK)
                 return rc;
-        
-        rc = hw_res_list_parse(&hw_resources, hw_res_parsed, flags);
+
+        rc = hw_res_list_parse(&pio_window, &hw_resources, hw_res_parsed,
+            flags);
         hw_res_clean_resource_list(&hw_resources);