blob: 9a316d1de397e6e60e9a89f4ef77e4f18eaabaa6 [file] [log] [blame]
Abdellatif El Khlifi857360c2023-04-17 10:11:52 +01001// SPDX-License-Identifier: GPL-2.0+
2/*
3 * Copyright 2023 Arm Limited and/or its affiliates <open-source-office@arm.com>
4 *
5 * Authors:
6 * Abdellatif El Khlifi <abdellatif.elkhlifi@arm.com>
7 */
8
9#include <common.h>
10#include <dm.h>
11#include <log.h>
Abdellatif El Khlifi6b005872023-04-17 10:11:55 +010012#if CONFIG_IS_ENABLED(SANDBOX64)
13#include <asm/test.h>
14#endif
Abdellatif El Khlifi857360c2023-04-17 10:11:52 +010015#include <linux/bitops.h>
16#include "nvmxip.h"
17
18/* LBA Macros */
19
20#define DEFAULT_LBA_SHIFT 10 /* 1024 bytes per block */
21#define DEFAULT_LBA_COUNT 1024 /* block count */
22
23#define DEFAULT_LBA_SZ BIT(DEFAULT_LBA_SHIFT)
24
Marek Vasutaec5dc72023-08-23 02:18:17 +020025int nvmxip_probe(struct udevice *udev)
Abdellatif El Khlifi857360c2023-04-17 10:11:52 +010026{
27 int ret;
28 struct udevice *bdev = NULL;
29 char bdev_name[NVMXIP_BLKDEV_NAME_SZ + 1];
30 int devnum;
31
Abdellatif El Khlifi857360c2023-04-17 10:11:52 +010032 devnum = uclass_id_count(UCLASS_NVMXIP);
33 snprintf(bdev_name, NVMXIP_BLKDEV_NAME_SZ, "blk#%d", devnum);
34
35 ret = blk_create_devicef(udev, NVMXIP_BLKDRV_NAME, bdev_name, UCLASS_NVMXIP,
36 devnum, DEFAULT_LBA_SZ,
37 DEFAULT_LBA_COUNT, &bdev);
38 if (ret) {
39 log_err("[%s]: failure during creation of the block device %s, error %d\n",
40 udev->name, bdev_name, ret);
41 return ret;
42 }
43
44 ret = blk_probe_or_unbind(bdev);
45 if (ret) {
46 log_err("[%s]: failure during probing the block device %s, error %d\n",
47 udev->name, bdev_name, ret);
48 return ret;
49 }
50
51 log_info("[%s]: the block device %s ready for use\n", udev->name, bdev_name);
52
Marek Vasutaec5dc72023-08-23 02:18:17 +020053 return 0;
54}
55
56static int nvmxip_post_bind(struct udevice *udev)
57{
58 dev_or_flags(udev, DM_FLAG_PROBE_AFTER_BIND);
Abdellatif El Khlifi857360c2023-04-17 10:11:52 +010059 return 0;
60}
61
62UCLASS_DRIVER(nvmxip) = {
63 .name = "nvmxip",
64 .id = UCLASS_NVMXIP,
65 .post_bind = nvmxip_post_bind,
66};