xref: /openbmc/u-boot/drivers/misc/misc_sandbox.c (revision 9450ab2b)
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 #include <common.h>
8 #include <dm.h>
9 #include <misc.h>
10 
11 struct misc_sandbox_priv {
12 	u8 mem[128];
13 	ulong last_ioctl;
14 	bool enabled;
15 };
16 
misc_sandbox_read(struct udevice * dev,int offset,void * buf,int size)17 int misc_sandbox_read(struct udevice *dev, int offset, void *buf, int size)
18 {
19 	struct misc_sandbox_priv *priv = dev_get_priv(dev);
20 
21 	memcpy(buf, priv->mem + offset, size);
22 
23 	return size;
24 }
25 
misc_sandbox_write(struct udevice * dev,int offset,const void * buf,int size)26 int misc_sandbox_write(struct udevice *dev, int offset, const void *buf,
27 		       int size)
28 {
29 	struct misc_sandbox_priv *priv = dev_get_priv(dev);
30 
31 	memcpy(priv->mem + offset, buf, size);
32 
33 	return size;
34 }
35 
misc_sandbox_ioctl(struct udevice * dev,unsigned long request,void * buf)36 int misc_sandbox_ioctl(struct udevice *dev, unsigned long request, void *buf)
37 {
38 	struct misc_sandbox_priv *priv = dev_get_priv(dev);
39 
40 	priv->last_ioctl = request;
41 
42 	return 0;
43 }
44 
misc_sandbox_call(struct udevice * dev,int msgid,void * tx_msg,int tx_size,void * rx_msg,int rx_size)45 int misc_sandbox_call(struct udevice *dev, int msgid, void *tx_msg,
46 		      int tx_size, void *rx_msg, int rx_size)
47 {
48 	struct misc_sandbox_priv *priv = dev_get_priv(dev);
49 
50 	if (msgid == 0) {
51 		int num = *(int *)tx_msg;
52 
53 		switch (num) {
54 		case 0:
55 			strncpy(rx_msg, "Zero", rx_size);
56 			break;
57 		case 1:
58 			strncpy(rx_msg, "One", rx_size);
59 			break;
60 		case 2:
61 			strncpy(rx_msg, "Two", rx_size);
62 			break;
63 		default:
64 			return -EINVAL;
65 		}
66 	}
67 
68 	if (msgid == 1) {
69 		int num = *(int *)tx_msg;
70 
71 		switch (num) {
72 		case 0:
73 			strncpy(rx_msg, "Forty", rx_size);
74 			break;
75 		case 1:
76 			strncpy(rx_msg, "Forty-one", rx_size);
77 			break;
78 		case 2:
79 			strncpy(rx_msg, "Forty-two", rx_size);
80 			break;
81 		default:
82 			return -EINVAL;
83 		}
84 	}
85 
86 	if (msgid == 2)
87 		memcpy(rx_msg, &priv->last_ioctl, sizeof(priv->last_ioctl));
88 
89 	if (msgid == 3)
90 		memcpy(rx_msg, &priv->enabled, sizeof(priv->enabled));
91 
92 	return 0;
93 }
94 
misc_sandbox_set_enabled(struct udevice * dev,bool val)95 int misc_sandbox_set_enabled(struct udevice *dev, bool val)
96 {
97 	struct misc_sandbox_priv *priv = dev_get_priv(dev);
98 
99 	priv->enabled = !priv->enabled;
100 
101 	return 0;
102 }
103 
104 static const struct misc_ops misc_sandbox_ops = {
105 	.read = misc_sandbox_read,
106 	.write = misc_sandbox_write,
107 	.ioctl = misc_sandbox_ioctl,
108 	.call = misc_sandbox_call,
109 	.set_enabled = misc_sandbox_set_enabled,
110 };
111 
misc_sandbox_probe(struct udevice * dev)112 int misc_sandbox_probe(struct udevice *dev)
113 {
114 	struct misc_sandbox_priv *priv = dev_get_priv(dev);
115 
116 	priv->enabled = true;
117 
118 	return 0;
119 }
120 
121 static const struct udevice_id misc_sandbox_ids[] = {
122 	{ .compatible = "sandbox,misc_sandbox" },
123 	{ }
124 };
125 
126 U_BOOT_DRIVER(misc_sandbox) = {
127 	.name           = "misc_sandbox",
128 	.id             = UCLASS_MISC,
129 	.ops		= &misc_sandbox_ops,
130 	.of_match       = misc_sandbox_ids,
131 	.probe          = misc_sandbox_probe,
132 	.priv_auto_alloc_size = sizeof(struct misc_sandbox_priv),
133 };
134