1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Copyright (c) 2013 Google, Inc
4 *
5 * (C) Copyright 2012
6 * Pavel Herrmann <morpheus.ibis@gmail.com>
7 */
8
9 #include <common.h>
10 #include <dm.h>
11 #include <dm-demo.h>
12 #include <errno.h>
13 #include <fdtdec.h>
14 #include <log.h>
15 #include <malloc.h>
16 #include <asm/global_data.h>
17 #include <asm/io.h>
18 #include <linux/list.h>
19
20 DECLARE_GLOBAL_DATA_PTR;
21
22 UCLASS_DRIVER(demo) = {
23 .name = "demo",
24 .id = UCLASS_DEMO,
25 };
26
demo_hello(struct udevice * dev,int ch)27 int demo_hello(struct udevice *dev, int ch)
28 {
29 const struct demo_ops *ops = device_get_ops(dev);
30
31 if (!ops->hello)
32 return -ENOSYS;
33
34 return ops->hello(dev, ch);
35 }
36
demo_status(struct udevice * dev,int * status)37 int demo_status(struct udevice *dev, int *status)
38 {
39 const struct demo_ops *ops = device_get_ops(dev);
40
41 if (!ops->status)
42 return -ENOSYS;
43
44 return ops->status(dev, status);
45 }
46
demo_get_light(struct udevice * dev)47 int demo_get_light(struct udevice *dev)
48 {
49 const struct demo_ops *ops = device_get_ops(dev);
50
51 if (!ops->get_light)
52 return -ENOSYS;
53
54 return ops->get_light(dev);
55 }
56
demo_set_light(struct udevice * dev,int light)57 int demo_set_light(struct udevice *dev, int light)
58 {
59 const struct demo_ops *ops = device_get_ops(dev);
60
61 if (!ops->set_light)
62 return -ENOSYS;
63
64 return ops->set_light(dev, light);
65 }
66
demo_parse_dt(struct udevice * dev)67 int demo_parse_dt(struct udevice *dev)
68 {
69 struct dm_demo_pdata *pdata = dev_get_plat(dev);
70 int dn = dev_of_offset(dev);
71
72 pdata->sides = fdtdec_get_int(gd->fdt_blob, dn, "sides", 0);
73 pdata->colour = fdt_getprop(gd->fdt_blob, dn, "colour", NULL);
74 if (!pdata->sides || !pdata->colour) {
75 debug("%s: Invalid device tree data\n", __func__);
76 return -EINVAL;
77 }
78
79 return 0;
80 }
81