common/qfw.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * (C) Copyright 2015 Miao Yan <yanmiaobest@gmail.com>
   4  * (C) Copyright 2021 Asherah Connor <ashe@kivikakk.ee>
   5  */
   6
   7 #include <dm.h>
   8 #include <dm/uclass.h>
   9 #include <qfw.h>
  10 #include <stdlib.h>
  11
  12 int qfw_get_dev(struct udevice **devp)
  13 {
  14         return uclass_first_device_err(UCLASS_QFW, devp);
  15 }
  16
  17 int qfw_online_cpus(struct udevice *dev)
  18 {
  19         u16 nb_cpus;
  20
  21         qfw_read_entry(dev, FW_CFG_NB_CPUS, 2, &nb_cpus);
  22
  23         return le16_to_cpu(nb_cpus);
  24 }
  25
  26 int qfw_read_firmware_list(struct udevice *dev)
  27 {
  28         int i;
  29         u32 count;
  30         struct fw_file *file;
  31         struct list_head *entry;
  32
  33         struct qfw_dev *qdev = dev_get_uclass_priv(dev);
  34
  35         /* don't read it twice */
  36         if (!list_empty(&qdev->fw_list))
  37                 return 0;
  38
  39         qfw_read_entry(dev, FW_CFG_FILE_DIR, 4, &count);
  40         if (!count)
  41                 return 0;
  42
  43         count = be32_to_cpu(count);
  44         for (i = 0; i < count; i++) {
  45                 file = malloc(sizeof(*file));
  46                 if (!file) {
  47                         printf("error: allocating resource\n");
  48                         goto err;
  49                 }
  50                 qfw_read_entry(dev, FW_CFG_INVALID,
  51                                sizeof(struct fw_cfg_file), &file->cfg);
  52                 file->addr = 0;
  53                 list_add_tail(&file->list, &qdev->fw_list);
  54         }
  55
  56         return 0;
  57
  58 err:
  59         list_for_each(entry, &qdev->fw_list) {
  60                 file = list_entry(entry, struct fw_file, list);
  61                 free(file);
  62         }
  63
  64         return -ENOMEM;
  65 }
  66
  67 struct fw_file *qfw_find_file(struct udevice *dev, const char *name)
  68 {
  69         struct list_head *entry;
  70         struct fw_file *file;
  71
  72         struct qfw_dev *qdev = dev_get_uclass_priv(dev);
  73
  74         list_for_each(entry, &qdev->fw_list) {
  75                 file = list_entry(entry, struct fw_file, list);
  76                 if (!strcmp(file->cfg.name, name))
  77                         return file;
  78         }
  79
  80         return NULL;
  81 }
  82
  83 struct fw_file *qfw_file_iter_init(struct udevice *dev,
  84                                    struct fw_cfg_file_iter *iter)
  85 {
  86         struct qfw_dev *qdev = dev_get_uclass_priv(dev);
  87
  88         iter->entry = qdev->fw_list.next;
  89         iter->end = &qdev->fw_list;
  90         return list_entry((struct list_head *)iter->entry,
  91                           struct fw_file, list);
  92 }
  93
  94 struct fw_file *qfw_file_iter_next(struct fw_cfg_file_iter *iter)
  95 {
  96         iter->entry = ((struct list_head *)iter->entry)->next;
  97         return list_entry((struct list_head *)iter->entry,
  98                           struct fw_file, list);
  99 }
 100
 101 bool qfw_file_iter_end(struct fw_cfg_file_iter *iter)
 102 {
 103         return iter->entry == iter->end;
 104 }