dm: timer: uclass: add timer init in uclass driver to add timer device

[oweals/u-boot.git] / drivers / timer / timer-uclass.c

diff --git a/drivers/timer/timer-uclass.c b/drivers/timer/timer-uclass.c
index aca421bdea331c4193d98adaf8ec350402ca23d6..04801784ba854d24c2be8823e5950f5809804495 100644 (file)
--- a/drivers/timer/timer-uclass.c
+++ b/drivers/timer/timer-uclass.c
@@ -6,6 +6,8 @@
 
 #include <common.h>
 #include <dm.h>
+#include <dm/lists.h>
+#include <dm/device-internal.h>
 #include <errno.h>
 #include <timer.h>
 
@@ -56,6 +58,48 @@ u64 timer_conv_64(u32 count)
        return ((u64)gd->timebase_h << 32) | gd->timebase_l;
 }
 
+int notrace dm_timer_init(void)
+{
+       const void *blob = gd->fdt_blob;
+       struct udevice *dev = NULL;
+       int node;
+       int ret;
+
+       if (gd->timer)
+               return 0;
+
+       /* Check for a chosen timer to be used for tick */
+       node = fdtdec_get_chosen_node(blob, "tick-timer");
+       if (node < 0) {
+               /* No chosen timer, trying first available timer */
+               ret = uclass_first_device(UCLASS_TIMER, &dev);
+               if (ret)
+                       return ret;
+               if (!dev)
+                       return -ENODEV;
+       } else {
+               if (uclass_get_device_by_of_offset(UCLASS_TIMER, node, &dev)) {
+                       /*
+                        * If the timer is not marked to be bound before
+                        * relocation, bind it anyway.
+                        */
+                       if (node > 0 &&
+                           !lists_bind_fdt(gd->dm_root, blob, node, &dev)) {
+                               ret = device_probe(dev);
+                               if (ret)
+                                       return ret;
+                       }
+               }
+       }
+
+       if (dev) {
+               gd->timer = dev;
+               return 0;
+       }
+
+       return -ENODEV;
+}
+
 UCLASS_DRIVER(timer) = {
        .id             = UCLASS_TIMER,
        .name           = "timer",