hc
2024-08-12 233ab1bd4c5697f5cdec94e60206e8c6ac609b4c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
/*
 * Copyright (C) 2010 Thomas Chou <thomas@wytron.com.tw>
 *
 * SPDX-License-Identifier:    GPL-2.0+
 */
 
#include <common.h>
#include <dm.h>
#include <errno.h>
#include <misc.h>
 
/*
 * Implement a  miscellaneous uclass for those do not fit other more
 * general classes. A set of generic read, write and ioctl methods may
 * be used to access the device.
 */
 
int misc_read(struct udevice *dev, int offset, void *buf, int size)
{
   const struct misc_ops *ops = device_get_ops(dev);
 
   if (!ops->read)
       return -ENOSYS;
 
   return ops->read(dev, offset, buf, size);
}
 
int misc_write(struct udevice *dev, int offset, void *buf, int size)
{
   const struct misc_ops *ops = device_get_ops(dev);
 
   if (!ops->write)
       return -ENOSYS;
 
   return ops->write(dev, offset, buf, size);
}
 
int misc_ioctl(struct udevice *dev, unsigned long request, void *buf)
{
   const struct misc_ops *ops = device_get_ops(dev);
 
   if (!ops->ioctl)
       return -ENOSYS;
 
   return ops->ioctl(dev, request, buf);
}
 
int misc_call(struct udevice *dev, int msgid, void *tx_msg, int tx_size,
         void *rx_msg, int rx_size)
{
   const struct misc_ops *ops = device_get_ops(dev);
 
   if (!ops->call)
       return -ENOSYS;
 
   return ops->call(dev, msgid, tx_msg, tx_size, rx_msg, rx_size);
}
 
struct udevice *misc_get_device_by_capability(u32 capability)
{
   const struct misc_ops *ops;
   struct udevice *dev;
   struct uclass *uc;
   int ret;
   u32 cap;
 
   ret = uclass_get(UCLASS_MISC, &uc);
   if (ret)
       return NULL;
 
   for (uclass_first_device(UCLASS_MISC, &dev);
        dev;
        uclass_next_device(&dev)) {
       ops = device_get_ops(dev);
       if (!ops || !ops->ioctl)
           continue;
 
       ret = ops->ioctl(dev, IOCTL_REQ_CAPABILITY, &cap);
       if (!ret && ((cap & capability) == capability))
           return dev;
   }
 
   return NULL;
}
 
UCLASS_DRIVER(misc) = {
   .id        = UCLASS_MISC,
   .name        = "misc",
};