LXR uboot/drivers/axi/axi-emul-uclass.c

   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * (C) Copyright 2018
   4 * Mario Six, Guntermann & Drunck GmbH, mario.six@gdsys.cc
   5 */
   6
   7#define LOG_CATEGORY UCLASS_AXI_EMUL
   8
   9#include <common.h>
  10#include <axi.h>
  11#include <dm.h>
  12#include <log.h>
  13#include <dm/device-internal.h>
  14#include <asm/axi.h>
  15
  16int axi_sandbox_get_emul(struct udevice *bus, ulong address,
  17                         enum axi_size_t size, struct udevice **emulp)
  18{
  19        struct udevice *dev;
  20        u32 reg[2];
  21        uint offset;
  22
  23        switch (size) {
  24        case AXI_SIZE_8:
  25                offset = 1;
  26                break;
  27        case AXI_SIZE_16:
  28                offset = 2;
  29                break;
  30        case AXI_SIZE_32:
  31                offset = 4;
  32                break;
  33        default:
  34                debug("%s: Unknown AXI transfer size '%d'", bus->name, size);
  35                offset = 0;
  36        }
  37
  38        /*
  39         * Note: device_find_* don't activate the devices; they're activated
  40         *       as-needed below.
  41         */
  42        for (device_find_first_child(bus, &dev);
  43             dev;
  44             device_find_next_child(&dev)) {
  45                int ret;
  46
  47                ret = dev_read_u32_array(dev, "reg", reg, ARRAY_SIZE(reg));
  48                if (ret) {
  49                        debug("%s: Could not read 'reg' property of %s\n",
  50                              bus->name, dev->name);
  51                        continue;
  52                }
  53
  54                /*
  55                 * Does the transfer's address fall into this device's address
  56                 * space?
  57                 */
  58                if (address >= reg[0] && address <= reg[0] + reg[1] - offset) {
  59                        /* If yes, activate it... */
  60                        if (device_probe(dev)) {
  61                                debug("%s: Could not activate %s\n",
  62                                      bus->name, dev->name);
  63                                return -ENODEV;
  64                        }
  65
  66                        /* ...and return it */
  67                        *emulp = dev;
  68                        return 0;
  69                }
  70        }
  71
  72        return -ENODEV;
  73}
  74
  75int axi_get_store(struct udevice *dev, u8 **storep)
  76{
  77        struct axi_emul_ops *ops = axi_emul_get_ops(dev);
  78
  79        if (!ops->get_store)
  80                return -ENOSYS;
  81
  82        return ops->get_store(dev, storep);
  83}
  84
  85UCLASS_DRIVER(axi_emul) = {
  86        .id             = UCLASS_AXI_EMUL,
  87        .name           = "axi_emul",
  88};
  89