[PATCH v2] bsps/shared/ofw: Implement RTEMS OFW interface

Niteesh G. S. niteesh.gs at gmail.com
Mon Aug 24 14:42:19 UTC 2020


ping.

On Sat, Aug 22, 2020 at 10:15 PM Niteesh G. S. <niteesh.gs at gmail.com> wrote:

> Hello,
>
> I went through the history of the OF implementation in NetBSD and FreeBSD.
> I have summarized the things I have found out below.
>
> The first OF implementation seems to come from NetBSD this is actually
> BSD-4
> licensed. FreeBSD and also other BSD have used this as the base and
> improved
> the API. For eg functions like OF_getprop_allloc_multi, OF_getencprop were
> not
> present in the original OF interface but were added by FreeBSD. And also
> NetBSD
> doesn't use KOBJS for function dispatch but rather uses platform-specific
> OF
> implementation, that is FDT implementation is present under
> sys/dev/fdt/fdt_openfirm.c
> powerPC implementation under arch/powerpc/openfirm.c.
> NetBSD openfirm.h:
> https://github.com/NetBSD/src/blob/trunk/sys/dev/ofw/openfirm.h
> And I think was adding the OF interface FreeBSD has added the BSD-2
> license.
>
>
> https://github.com/freebsd/freebsd/commit/d84d862cbd66f3f9ab4ce65fe69893664689c73b
> This is the commit where they have added OF interface to FreeBSD and from
> the
> commit it seems like they have added the BSD-2 license with the interface
> itself.
> And the functions where we worry about the similarity are all FreeBSD
> extension
> so I guess we won't have any issue since they would come under BSD-2
> license.
>
>
> Thanks,
> Niteesh.
>
> On Sat, Aug 22, 2020 at 7:23 PM Gedare Bloom <gedare at rtems.org> wrote:
>
>> On Fri, Aug 21, 2020 at 11:26 AM Niteesh G. S. <niteesh.gs at gmail.com>
>> wrote:
>> >
>> >
>> >
>> > On Fri, Aug 21, 2020 at 9:38 PM Gedare Bloom <gedare at rtems.org> wrote:
>> >>
>> >> Hi Niteesh,
>> >>
>> >> Can you explain how you developed the new code in a way that ensures
>> >> that we do not have any of the previously 4-BSD licensed code left?
>> >
>> > The FDT implementation of the OF interface present is ofw_fdt.c is,
>> fortunately,
>> > BSD-2 licensed so I was able to copy/reuse most of it for RTEMS ofw.c
>> >
>> > The interface(openfirm.h) and the implementation(opefirm.c) that calls
>> the
>> > respective KOBJs functions are BSD-4 licensed. Since it was mentioned
>> that
>> > copying the interface is fine I don't think there is an issue with it.
>> The OF
>> > interface in RTEMS is present in ofw_compat.h
>> >
>> > I also want to make note of one thing, there are few functions in ofw.c
>> > which look exactly the same as the ones present in openfirm.c can you
>> > please make sure that these functions won't cause any issues.
>> > Few examples are, rtems_ofw_get_enc_prop_alloc,
>> rtems_ofw_get_enc_prop_alloc_multi.
>> >
>> The similarity in these functions is problematic.
>>
>> I still think it would be worth the trouble to try to dig through the
>> history to find exactly what code was introduced with the 4-bsd. I
>> would guess that came out of netbsd.
>>
>> > Thanks,
>> > Niteesh.
>> >
>> >>
>> >> Gedare
>> >>
>> >> On Thu, Aug 20, 2020 at 1:52 AM G S Niteesh Babu <niteesh.gs at gmail.com>
>> wrote:
>> >> >
>> >> > RTEMS OFW is a FDT only implementation of the OpenFirmWare
>> >> > interface. This API is created to be compatible with FreeBSD
>> >> > OpenFirmWare interface. The main intention is to make
>> >> > porting of FreeBSD drivers to RTEMS easier.
>> >> >
>> >> > Most functions implemented have an direct one-one mapping
>> >> > with the original OFW API and some extra auxiliary functions
>> >> > were implemented to make working with device trees easier in
>> >> > RTEMS.
>> >> >
>> >> > Update #3784
>> >> > ---
>> >> >  bsps/include/ofw/ofw.h        | 548 +++++++++++++++++++++++++++
>> >> >  bsps/include/ofw/ofw_compat.h |  74 ++++
>> >> >  bsps/shared/ofw/ofw.c         | 670
>> ++++++++++++++++++++++++++++++++++
>> >> >  spec/build/bsps/obj.yml       |   4 +
>> >> >  4 files changed, 1296 insertions(+)
>> >> >  create mode 100644 bsps/include/ofw/ofw.h
>> >> >  create mode 100644 bsps/include/ofw/ofw_compat.h
>> >> >  create mode 100644 bsps/shared/ofw/ofw.c
>> >> >
>> >> > diff --git a/bsps/include/ofw/ofw.h b/bsps/include/ofw/ofw.h
>> >> > new file mode 100644
>> >> > index 0000000000..50f64ff695
>> >> > --- /dev/null
>> >> > +++ b/bsps/include/ofw/ofw.h
>> >> > @@ -0,0 +1,548 @@
>> >> > +/* SPDX-License-Identifier: BSD-2-Clause */
>> >> > +
>> >> > +/**
>> >> > + * @file
>> >> > + *
>> >> > + * @ingroup ofw
>> >> > + *
>> >> > + * RTEMS FDT implementation of OpenFirmWare Interface.
>> >> > + *
>> >> > + * RTEMS OFW is a FDT only implementation of the OpenFirmWare
>> interface.
>> >> > + * This API is created to be compatible with FreeBSD OpenFirmWare
>> interface.
>> >> > + * The main intention is to make porting of FreeBSD drivers to
>> RTEMS easier.
>> >> > + */
>> >> > +
>> >> > +/*
>> >> > + * Copyright (C) 2020 Niteesh Babu G S <niteesh.gs at gmail.com>
>> >> > + *
>> >> > + * Redistribution and use in source and binary forms, with or
>> without
>> >> > + * modification, are permitted provided that the following
>> conditions
>> >> > + * are met:
>> >> > + * 1. Redistributions of source code must retain the above copyright
>> >> > + *    notice, this list of conditions and the following disclaimer.
>> >> > + * 2. Redistributions in binary form must reproduce the above
>> copyright
>> >> > + *    notice, this list of conditions and the following disclaimer
>> in the
>> >> > + *    documentation and/or other materials provided with the
>> distribution.
>> >> > + *
>> >> > + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
>> CONTRIBUTORS "AS IS"
>> >> > + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
>> LIMITED TO, THE
>> >> > + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
>> PARTICULAR PURPOSE
>> >> > + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
>> CONTRIBUTORS BE
>> >> > + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
>> OR
>> >> > + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
>> PROCUREMENT OF
>> >> > + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
>> BUSINESS
>> >> > + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
>> WHETHER IN
>> >> > + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
>> OTHERWISE)
>> >> > + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
>> ADVISED OF THE
>> >> > + * POSSIBILITY OF SUCH DAMAGE.
>> >> > + */
>> >> > +
>> >> > +#ifndef _OFW_H
>> >> > +#define _OFW_H
>> >> > +
>> >> > +#ifdef __cplusplus
>> >> > +extern "C" {
>> >> > +#endif
>> >> > +
>> >> > +#include <rtems.h>
>> >> > +#include <stdint.h>
>> >> > +#include <stddef.h>
>> >> > +
>> >> > +/**
>> >> > + * Represents a node in the device tree. The offset from fdtp to
>> node is used
>> >> > + * instead of fdt offset to make sure this is compatible with OF
>> interface in
>> >> > + * FreeBSD.
>> >> > + */
>> >> > +typedef uint32_t  phandle_t;
>> >> > +/**
>> >> > + * Represents the effective phandle of the node.
>> >> > + */
>> >> > +typedef uint32_t  ihandle_t;
>> >> > +/**
>> >> > + * Represents the data type of the buffer.
>> >> > + */
>> >> > +typedef uint32_t  pcell_t;
>> >> > +
>> >> > +/**
>> >> > + * @struct rtems_ofw_memory_area
>> >> > + *
>> >> > + * This is used to represent elements(FDT properties) that define
>> >> > + * region of memory address.
>> >> > + */
>> >> > +typedef struct {
>> >> > +  /** The start address of the memory region. */
>> >> > +  uint32_t start;
>> >> > +  /** The size of the memory region. */
>> >> > +  uint32_t size;
>> >> > +} rtems_ofw_memory_area;
>> >> > +
>> >> > +/**
>> >> > + * @struct rtems_ofw_ranges
>> >> > + *
>> >> > + * This is used to represent the ranges property in the device tree.
>> >> > + */
>> >> > +typedef struct {
>> >> > +  /** The physical address within the child bus address space */
>> >> > +  uint32_t child_bus;
>> >> > +  /** The physical address within the parent bus address space */
>> >> > +  uint32_t parent_bus;
>> >> > +  /** The size of the range in the child’s address space */
>> >> > +  uint32_t size;
>> >> > +} rtems_ofw_ranges;
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the node that is next to @a node.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + *
>> >> > + * @retval Peer node offset Successful operation.
>> >> > + * @retval 0 No peer node or invalid node handle
>> >> > + */
>> >> > +phandle_t rtems_ofw_peer(
>> >> > +  phandle_t   node
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the node that is the child of @a node.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + *
>> >> > + * @retval child node offset Successful operation.
>> >> > + * @retval 0 No child node or invalid node handle
>> >> > + */
>> >> > +phandle_t rtems_ofw_child(
>> >> > +  phandle_t   node
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the node that is the parent of @a node.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + *
>> >> > + * @retval child node offset Successful operation.
>> >> > + * @retval 0 No child node or invalid node handle
>> >> > + */
>> >> > +phandle_t rtems_ofw_parent(
>> >> > +  phandle_t   node
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the length of the property mentioned in @a propname.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] prop Property name
>> >> > + *
>> >> > + * @retval -1 Invalid node or property
>> >> > + * @retval  Length of property on successful operation
>> >> > + */
>> >> > +size_t rtems_ofw_get_prop_len(
>> >> > +  phandle_t   node,
>> >> > +  const char *propname
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the value of property mentioned in @a propname.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] prop Property name
>> >> > + * @param[out] buf The property value gets stored in this buffer
>> (Pre-allocated)
>> >> > + * @param[in] len Length of the buffer
>> >> > +
>> >> > + * @retval -1 Invalid node or property
>> >> > + * @retval  Length of property on successful operation
>> >> > + */
>> >> > +size_t rtems_ofw_get_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void        *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the value of property mentioned in @a prop.
>> >> > + *
>> >> > + * Gets the value of property of @a node and converts the value
>> into the host's
>> >> > + * endianness.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] prop Property name
>> >> > + * @param[out] buf The property value gets stored in this
>> buffer(Pre-allocated)
>> >> > + * after converted to the host's endianness
>> >> > + * @param[in] len Length of the buffer
>> >> > + *
>> >> > + * @retval -1 Invalid node or property
>> >> > + * @retval  Length of property on successful operation
>> >> > + */
>> >> > +size_t rtems_ofw_get_enc_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *prop,
>> >> > +  pcell_t     *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Checks if the property @a propname is present in @a node.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + *
>> >> > + *  @retval  0 Property not present.
>> >> > + *  @retval  1 Property is present.
>> >> > + */
>> >> > +int rtems_ofw_has_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Searches for property @a propname in @a node.
>> >> > + *
>> >> > + * Searches the node and its parent recursively for the property
>> and fills the
>> >> > + * buffer with the first found value.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + * @param[out] buf The property value gets stored in this buffer
>> (Pre-allocated)
>> >> > + * @param[in] len Length of the buffer
>> >> > + *
>> >> > + * @retval  Length of the property if property is found.
>> >> > + * @retval  -1 Property is not found.
>> >> > + */
>> >> > +size_t rtems_ofw_search_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void        *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Searches for property @a propname in @a node.
>> >> > + *
>> >> > + * Searches the node and its parent recursively for the property
>> and fills the
>> >> > + * buffer with the first value found after converting it to the
>> endianness of
>> >> > + * the host.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + * @param[out] buf The property value gets stored in this
>> buffer(Pre-allocated)
>> >> > + * after converted to the host's endianness
>> >> > + * @param[in] len Length of the buffer
>> >> > + *
>> >> > + * @retval  Length of the property if property is found.
>> >> > + * @retval  -1 Property is not found.
>> >> > + */
>> >> > +size_t rtems_ofw_search_enc_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  pcell_t     *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the value of property mentioned in @a propname.
>> >> > + *
>> >> > + * Same as rtems_ofw_getprop, but the @a buf is allocated in this
>> routine and
>> >> > + * the user is responsible for freeing it.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + * @param[out] buf The buffer is allocated in this routine and user
>> is
>> >> > + * responsible for freeing.
>> >> > + *
>> >> > + * @retval  -1 Property is not found.
>> >> > + * @retval  Length of the property if property is found.
>> >> > + */
>> >> > +size_t rtems_ofw_get_prop_alloc(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void       **buf
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets multiple values of the property @a propname.
>> >> > + *
>> >> > + * Same as rtems_ofw_getprop_alloc but it can read properties with
>> multiple
>> >> > + * values.
>> >> > + * For eg: reg = <0x1000 0x10 0x2000 0x20>
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + * @param[in] elsz Size of the single value
>> >> > + * @param[out] buf The buffer is allocated in this routine and user
>> is
>> >> > + * responsible for freeing.
>> >> > + *
>> >> > + * @retval  -1 Property is not found.
>> >> > + * @retval   Number of values read.
>> >> > + */
>> >> > +size_t rtems_ofw_get_prop_alloc_multi(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  int          elsz,
>> >> > +  void       **buf
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets the value of property mentioned in @a propname.
>> >> > + *
>> >> > + * Same as rtems_ofw_getprop_alloc but the value stored in the
>> buffer is
>> >> > + * converted into the host's endianness.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + * @param[out] buf The buffer is allocated in this routine and user
>> is
>> >> > + * responsible for freeing.
>> >> > + *
>> >> > + * @retval  -1 Property is not found.
>> >> > + * @retval  Length of the property if property is found.
>> >> > + */
>> >> > +size_t rtems_ofw_get_enc_prop_alloc(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void       **buf
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets multiple values of the property @a propname.
>> >> > + *
>> >> > + * Same as rtems_ofw_getprop_alloc_multi but the values stored in
>> the buffer
>> >> > + * are converted to the host's endianness.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] propname Property name
>> >> > + * @param[in] elsz Size of the single value
>> >> > + * @param[out] buf The buffer is allocated in this routine and user
>> is
>> >> > + * responsible for freeing.
>> >> > + *
>> >> > + * @retval  -1 Property is not found.
>> >> > + * @retval   Number of values read.
>> >> > + */
>> >> > +size_t rtems_ofw_get_enc_prop_alloc_multi(
>> >> > +  phandle_t     node,
>> >> > +  const char   *propname,
>> >> > +  int           elsz,
>> >> > +  void        **buf
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Free's the buffers allocated by the rtems_ofw_*_alloc
>> functions.
>> >> > + *
>> >> > + * @param[in] buf Buffer to be freed
>> >> > + */
>> >> > +void rtems_ofw_free(
>> >> > +  void   *buf
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Finds the next property of @a node.
>> >> > + *
>> >> > + * Finds the next property of the node and when @a propname is NULL
>> it returns
>> >> > + * the value in the first property.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] previous Previous property name
>> >> > + * @param[out] buf The value of the next property gets stored in
>> this buffer
>> >> > + * (Pre-allocated)
>> >> > + * @param[in] len Length of the buffer
>> >> > + *
>> >> > + * @retval  -1 node or previous property does not exist
>> >> > + * @retval   0 no more properties
>> >> > + * @retval   1 success
>> >> > + */
>> >> > +int rtems_ofw_next_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *previous,
>> >> > +  char        *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Sets the property @name of @a node to @a buf.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[in] name Property name
>> >> > + * @param[in] buf Buffer contains the value to be set.
>> >> > + * @param[in] len Length of the buffer
>> >> > + *
>> >> > + * @retval  -1 node does not exist
>> >> > + * @retval   0 on success
>> >> > + * @retval   libFDT error codes on unsuccessful setting operation
>> >> > + */
>> >> > +int rtems_ofw_set_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *name,
>> >> > +  const void  *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Converts a device specifier to a fully qualified path
>> name.
>> >> > + *
>> >> > + * @param[in] dev device specifier
>> >> > + * @param[out] buf The path is filled into the buffer(Pre-allocated)
>> >> > + * @param[in] length of the buffer
>> >> > + *
>> >> > + * @retval  -1 always. Unimplemented.
>> >> > + */
>> >> > +size_t rtems_ofw_canon(
>> >> > +  const char  *dev,
>> >> > +  char        *buf,
>> >> > +  size_t       len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Finds the node at the given path
>> >> > + *
>> >> > + * @param[in] path to the node from root
>> >> > + *
>> >> > + * @retval  -1 node does not exist
>> >> > + * @retval   node handle on success
>> >> > + */
>> >> > +phandle_t rtems_ofw_find_device(
>> >> > +  const char  *path
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief This routine converts effective phandle @a xref to node
>> offset.
>> >> > + *
>> >> > + * @param[in] xref Node phandle
>> >> > + *
>> >> > + * @retval Node offset on success
>> >> > + * @retval Node phandle on failure
>> >> > + */
>> >> > +phandle_t rtems_ofw_node_from_xref(
>> >> > +  phandle_t   xref
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief This routine converts node offset to effective phandle of
>> @a node.
>> >> > + *
>> >> > + * @retval Node phandle on success
>> >> > + * @retval Node offset on failure
>> >> > + */
>> >> > +phandle_t rtems_ofw_xref_from_node(
>> >> > +  phandle_t   node
>> >> > +);
>> >> > +
>> >> > +/*
>> >> > + * instance handles(ihandle_t) as same as phandles in the FDT
>> implementation
>> >> > + * of OF interface.
>> >> > + */
>> >> > +
>> >> > +/**
>> >> > + * @brief Converts @a instance handle to phandle.
>> >> > + *
>> >> > + * instance are same as node offsets in FDT.
>> >> > + *
>> >> > + * @param[in] instance Node offset
>> >> > + *
>> >> > + * @retval phandle of node on success.
>> >> > + * @retval instance of node on failure.
>> >> > + */
>> >> > +phandle_t rtems_ofw_instance_to_package(
>> >> > +  ihandle_t   instance
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Find the node's path from phandle.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[out] buf Path is filled into this buffer(Pre-allocated).
>> >> > + * @param[in] len Length of the buffer.
>> >> > + *
>> >> > + * @retval -1 always. Unimplemented.
>> >> > + */
>> >> > +size_t rtems_ofw_package_to_path(
>> >> > +  phandle_t   node,
>> >> > +  char       *buf,
>> >> > +  size_t      len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Find the node's path from ihandle.
>> >> > + *
>> >> > + * @param[in] instance Node offset
>> >> > + * @param[out] buf Path is filled into this buffer(Pre-allocated).
>> >> > + * @param[in] len Length of the buffer.
>> >> > + *
>> >> > + * @retval -1 always. Unimplemented.
>> >> > + */
>> >> > +size_t rtems_ofw_instance_to_path(
>> >> > +  ihandle_t  instance,
>> >> > +  char      *buf,
>> >> > +  size_t     len
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Queries the node's reg value.
>> >> > + *
>> >> > + * This routine fills the buffer @a buf with the values in reg
>> property of node
>> >> > + * @a node. It reads all the values of the property and fills the
>> buffer to max
>> >> > + * size.
>> >> > + * This routine is local to RTEMS OFW and does not have an
>> corresponding
>> >> > + * FreeBSD OFW pair.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[out] buf Register values are stored in this
>> buffer(Pre-allocated).
>> >> > + * @param[in] size Length of the buffer.
>> >> > + *
>> >> > + * @retval -1 If reg property is missing.
>> >> > + * @retval  Length of the reg property in bytes.
>> >> > + */
>> >> > +int rtems_ofw_get_reg(
>> >> > +  phandle_t              node,
>> >> > +  rtems_ofw_memory_area *buf,
>> >> > +  size_t                 size
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Queries the node's interrupt value.
>> >> > + *
>> >> > + * This routine fills the buffer @a buf with the interrupt number.
>> In case of
>> >> > + * multiple numbers it fills the buffer to its full extent.
>> >> > + * This routine is local to RTEMS OFW and does not have an
>> corresponding
>> >> > + * FreeBSD OFW pair.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + * @param[out] buf Interrupt values are stored in this
>> buffer(Pre-allocated).
>> >> > + * @param[in] size Length of the buffer.
>> >> > + *
>> >> > + * @retval -1 If interrupts property is missing.
>> >> > + * @retval  The number of interrupt numbers read.
>> >> > + */
>> >> > +int rtems_ofw_get_interrupts(
>> >> > +  phandle_t            node,
>> >> > +  rtems_vector_number *buf,
>> >> > +  size_t               size
>> >> > +);
>> >> > +
>> >> > +/**
>> >> > + * @brief Queries the node's status.
>> >> > + *
>> >> > + * This routine is local to RTEMS OFW and does not have an
>> corresponding
>> >> > + * FreeBSD OFW pair.
>> >> > + *
>> >> > + * @param[in] node Node offset
>> >> > + *
>> >> > + * @retval true  Status is OK or empty.
>> >> > + * @retval false Status is not OK or missing.
>> >> > + */
>> >> > +bool rtems_ofw_node_status( phandle_t node );
>> >> > +
>> >> > +/**
>> >> > + * @brief Gets node phandle from compatible property.
>> >> > + *
>> >> > + * This routine is local to RTEMS OFW and does not have an
>> corresponding
>> >> > + * FreeBSD OFW pair.
>> >> > + *
>> >> > + * @param[in] compat Compatible string
>> >> > + *
>> >> > + * @retval 0 Node with @a compat as compatible string not found
>> >> > + * @retval Node phandle on success.
>> >> > + */
>> >> > +phandle_t rtems_ofw_find_device_by_compat( const char *compat );
>> >> > +
>> >> > +#ifdef __cplusplus
>> >> > +}
>> >> > +#endif
>> >> > +
>> >> > +#endif /* _OFW_H */
>> >> > diff --git a/bsps/include/ofw/ofw_compat.h
>> b/bsps/include/ofw/ofw_compat.h
>> >> > new file mode 100644
>> >> > index 0000000000..be4a5ea3ce
>> >> > --- /dev/null
>> >> > +++ b/bsps/include/ofw/ofw_compat.h
>> >> > @@ -0,0 +1,74 @@
>> >> > +/* SPDX-License-Identifier: BSD-2-Clause */
>> >> > +
>> >> > +/**
>> >> > + * @file
>> >> > + *
>> >> > + * @ingroup ofw
>> >> > + *
>> >> > + * This file defines necessary symbols to make the RTEMS OFW API
>> compatible
>> >> > + * with FreeBSD OFW.
>> >> > + */
>> >> > +
>> >> > +/*
>> >> > + * Copyright (C) 2020 Niteesh Babu G S <niteesh.gs at gmail.com>
>> >> > + *
>> >> > + * Redistribution and use in source and binary forms, with or
>> without
>> >> > + * modification, are permitted provided that the following
>> conditions
>> >> > + * are met:
>> >> > + * 1. Redistributions of source code must retain the above copyright
>> >> > + *    notice, this list of conditions and the following disclaimer.
>> >> > + * 2. Redistributions in binary form must reproduce the above
>> copyright
>> >> > + *    notice, this list of conditions and the following disclaimer
>> in the
>> >> > + *    documentation and/or other materials provided with the
>> distribution.
>> >> > + *
>> >> > + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
>> CONTRIBUTORS "AS IS"
>> >> > + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
>> LIMITED TO, THE
>> >> > + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
>> PARTICULAR PURPOSE
>> >> > + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
>> CONTRIBUTORS BE
>> >> > + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
>> OR
>> >> > + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
>> PROCUREMENT OF
>> >> > + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
>> BUSINESS
>> >> > + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
>> WHETHER IN
>> >> > + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
>> OTHERWISE)
>> >> > + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
>> ADVISED OF THE
>> >> > + * POSSIBILITY OF SUCH DAMAGE.
>> >> > + */
>> >> > +
>> >> > +#ifndef _OFW_COMPAT_H
>> >> > +#define _OFW_COMPAT_H
>> >> > +
>> >> > +#ifdef __cplusplus
>> >> > +extern "C" {
>> >> > +#endif
>> >> > +
>> >> > +#include <ofw/ofw.h>
>> >> > +
>> >> > +#define OF_peer                   rtems_ofw_peer
>> >> > +#define OF_child                  rtems_ofw_child
>> >> > +#define OF_parent                 rtems_ofw_parent
>> >> > +#define OF_getproplen             rtems_ofw_get_prop_len
>> >> > +#define OF_getprop                rtems_ofw_get_prop
>> >> > +#define OF_getencprop             rtems_ofw_get_enc_prop
>> >> > +#define OF_hasprop                rtems_ofw_has_prop
>> >> > +#define OF_searchprop             rtems_ofw_search_prop
>> >> > +#define OF_searchencprop          rtems_ofw_search_enc_prop
>> >> > +#define OF_getprop_alloc          rtems_ofw_get_prop_alloc
>> >> > +#define OF_getprop_alloc_multi    rtems_ofw_get_prop_alloc_multi
>> >> > +#define OF_getencprop_alloc_multi rtems_ofw_get_enc_prop_alloc_multi
>> >> > +#define OF_getencprop_alloc       rtems_ofw_get_enc_prop_alloc
>> >> > +#define OF_prop_free              rtems_ofw_free
>> >> > +#define OF_nextprop               rtems_ofw_next_prop
>> >> > +#define OF_setprop                rtems_ofw_set_prop
>> >> > +#define OF_canon                  rtems_ofw_canon
>> >> > +#define OF_finddevice             rtems_ofw_find_device
>> >> > +#define OF_package_to_path        rtems_ofw_package_to_path
>> >> > +#define OF_node_from_xref         rtems_ofw_node_from_xref
>> >> > +#define OF_xref_from_node         rtems_ofw_xref_from_node
>> >> > +#define OF_instance_to_package    rtems_ofw_instance_to_package
>> >> > +#define OF_instance_to_path       rtems_ofw_instance_to_path
>> >> > +
>> >> > +#ifdef __cplusplus
>> >> > +}
>> >> > +#endif
>> >> > +
>> >> > +#endif /* _OFW_COMPAT_H */
>> >> > diff --git a/bsps/shared/ofw/ofw.c b/bsps/shared/ofw/ofw.c
>> >> > new file mode 100644
>> >> > index 0000000000..481b29553b
>> >> > --- /dev/null
>> >> > +++ b/bsps/shared/ofw/ofw.c
>> >> > @@ -0,0 +1,670 @@
>> >> > +/* SPDX-License-Identifier: BSD-2-Clause */
>> >> > +
>> >> > +/**
>> >> > + * @file
>> >> > + *
>> >> > + * @ingroup ofw
>> >> > + */
>> >> > +
>> >> > +/*
>> >> > + * Copyright (C) 2020 Niteesh Babu G S <niteesh.gs at gmail.com>
>> >> > + *
>> >> > + * Redistribution and use in source and binary forms, with or
>> without
>> >> > + * modification, are permitted provided that the following
>> conditions
>> >> > + * are met:
>> >> > + * 1. Redistributions of source code must retain the above copyright
>> >> > + *    notice, this list of conditions and the following disclaimer.
>> >> > + * 2. Redistributions in binary form must reproduce the above
>> copyright
>> >> > + *    notice, this list of conditions and the following disclaimer
>> in the
>> >> > + *    documentation and/or other materials provided with the
>> distribution.
>> >> > + *
>> >> > + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND
>> CONTRIBUTORS "AS IS"
>> >> > + * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
>> LIMITED TO, THE
>> >> > + * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
>> PARTICULAR PURPOSE
>> >> > + * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR
>> CONTRIBUTORS BE
>> >> > + * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,
>> OR
>> >> > + * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
>> PROCUREMENT OF
>> >> > + * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR
>> BUSINESS
>> >> > + * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
>> WHETHER IN
>> >> > + * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
>> OTHERWISE)
>> >> > + * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
>> ADVISED OF THE
>> >> > + * POSSIBILITY OF SUCH DAMAGE.
>> >> > + */
>> >> > +
>> >> > +#ifdef HAVE_CONFIG_H
>> >> > +#include "config.h"
>> >> > +#endif
>> >> > +
>> >> > +#include <bsp/fdt.h>
>> >> > +#include <sys/param.h>
>> >> > +#include <ofw/ofw.h>
>> >> > +#include <libfdt.h>
>> >> > +#include <assert.h>
>> >> > +#include <rtems/sysinit.h>
>> >> > +
>> >> > +const void *fdtp = NULL;
>> >> > +
>> >> > +static phandle_t rtems_fdt_offset_to_phandle( int offset )
>> >> > +{
>> >> > +  if (offset < 0) {
>> >> > +    return 0;
>> >> > +  }
>> >> > +
>> >> > +  return (phandle_t)offset + fdt_off_dt_struct(fdtp);
>> >> > +}
>> >> > +
>> >> > +static int rtems_fdt_phandle_to_offset( phandle_t handle )
>> >> > +{
>> >> > +  int off;
>> >> > +  int fdt_off;
>> >> > +
>> >> > +  off = (int) handle;
>> >> > +  fdt_off = fdt_off_dt_struct(fdtp);
>> >> > +
>> >> > +  if (off < fdt_off) {
>> >> > +    return -1;
>> >> > +
>> >> > +  }
>> >> > +
>> >> > +  return off - fdt_off;
>> >> > +}
>> >> > +
>> >> > +static void rtems_ofw_init( void ) {
>> >> > +  int rv;
>> >> > +  const void *fdt;
>> >> > +
>> >> > +  fdt = bsp_fdt_get();
>> >> > +
>> >> > +  rv = fdt_check_header(fdt);
>> >> > +
>> >> > +  /*
>> >> > +   * If the FDT is invalid exit through fatal.
>> >> > +   */
>> >> > +  if (rv != 0) {
>> >> > +    rtems_fatal_error_occurred(RTEMS_NOT_CONFIGURED);
>> >> > +  }
>> >> > +
>> >> > +  fdtp = fdt;
>> >> > +}
>> >> > +
>> >> > +RTEMS_SYSINIT_ITEM(
>> >> > +  rtems_ofw_init,
>> >> > +  RTEMS_SYSINIT_BSP_PRE_DRIVERS,
>> >> > +  RTEMS_SYSINIT_ORDER_FIRST
>> >> > +);
>> >> > +
>> >> > +phandle_t rtems_ofw_peer( phandle_t node )
>> >> > +{
>> >> > +  int offset;
>> >> > +
>> >> > +  if (node == 0) {
>> >> > +    int root = fdt_path_offset(fdtp, "/");
>> >> > +    return rtems_fdt_offset_to_phandle(root);
>> >> > +  }
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +  if (offset < 0) {
>> >> > +    return 0;
>> >> > +  }
>> >> > +
>> >> > +  offset = fdt_next_subnode(fdtp, offset);
>> >> > +  return rtems_fdt_offset_to_phandle(offset);
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_child( phandle_t node )
>> >> > +{
>> >> > +  int offset;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  if (offset < 0) {
>> >> > +    return 0;
>> >> > +  }
>> >> > +
>> >> > +  offset = fdt_first_subnode(fdtp, offset);
>> >> > +  return rtems_fdt_offset_to_phandle(offset);
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_parent( phandle_t node )
>> >> > +{
>> >> > +  int offset;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  if (offset < 0) {
>> >> > +    return 0;
>> >> > +  }
>> >> > +
>> >> > +  offset = fdt_parent_offset(fdtp, offset);
>> >> > +  return rtems_fdt_offset_to_phandle(offset);
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_prop_len(
>> >> > +  phandle_t node,
>> >> > +  const char *propname
>> >> > +)
>> >> > +{
>> >> > +  int offset;
>> >> > +  int len;
>> >> > +  const void *prop;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  if (offset < 0) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  prop = fdt_getprop(fdtp, offset, propname, &len);
>> >> > +
>> >> > +  if (prop == NULL && strcmp(propname, "name") == 0) {
>> >> > +    fdt_get_name(fdtp, offset, &len);
>> >> > +    return len + 1;
>> >> > +  }
>> >> > +
>> >> > +  if (prop == NULL && strcmp(propname, "/chosen") == 0) {
>> >> > +    if (strcmp(propname, "fdtbootcpu") == 0)
>> >> > +      return sizeof(pcell_t);
>> >> > +    if (strcmp(propname, "fdtmemreserv") == 0)
>> >> > +      return 2 * sizeof(uint64_t) * fdt_num_mem_rsv(fdtp);
>> >> > +  }
>> >> > +
>> >> > +  if (prop == NULL) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  return len;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void        *buf,
>> >> > +  size_t       bufsize
>> >> > +)
>> >> > +{
>> >> > +  const void *prop;
>> >> > +  int offset;
>> >> > +  int len;
>> >> > +  uint32_t cpuid;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  if (offset < 0) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  prop = fdt_getprop(fdtp, offset, propname, &len);
>> >> > +
>> >> > +  if (prop == NULL && strcmp(propname, "name") == 0) {
>> >> > +    prop = fdt_get_name(fdtp, offset, &len);
>> >> > +    strncpy(buf, prop, bufsize);
>> >> > +    return len + 1;
>> >> > +  }
>> >> > +
>> >> > +  if (prop == NULL && strcmp(propname, "/chosen") == 0) {
>> >> > +    if (strcmp(propname, "fdtbootcpu") == 0) {
>> >> > +      cpuid = cpu_to_fdt32(fdt_boot_cpuid_phys(fdtp));
>> >> > +      len = sizeof(cpuid);
>> >> > +      prop = &cpuid;
>> >> > +    }
>> >> > +    if (strcmp(propname, "fdtmemreserv") == 0) {
>> >> > +      prop = (char *)fdtp + fdt_off_mem_rsvmap(fdtp);
>> >> > +      len = sizeof(uint64_t)*2*fdt_num_mem_rsv(fdtp);
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  if (prop == NULL) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  bcopy(prop, buf, MIN(len, bufsize));
>> >> > +
>> >> > +  return len;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_enc_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *prop,
>> >> > +  pcell_t     *buf,
>> >> > +  size_t       len
>> >> > +)
>> >> > +{
>> >> > +  size_t rv;
>> >> > +
>> >> > +  assert(len % 4 == 0);
>> >> > +  rv = rtems_ofw_get_prop(node, prop, buf, len);
>> >> > +
>> >> > +  if (rv < 0) {
>> >> > +    return rv;
>> >> > +  }
>> >> > +
>> >> > +  for (int i = 0; i < (len / 4); i++) {
>> >> > +    buf[i] = fdt32_to_cpu(buf[i]);
>> >> > +  }
>> >> > +
>> >> > +  return rv;
>> >> > +}
>> >> > +
>> >> > +int rtems_ofw_has_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname
>> >> > +)
>> >> > +{
>> >> > +  size_t rv;
>> >> > +
>> >> > +  rv = rtems_ofw_get_prop_len(node, propname);
>> >> > +  return rv >= 0 ? 1 : 0;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_search_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void        *buf,
>> >> > +  size_t       len
>> >> > +)
>> >> > +{
>> >> > +  size_t rv;
>> >> > +
>> >> > +  for (; node != 0; node = rtems_ofw_parent(node)) {
>> >> > +    if ((rv = rtems_ofw_get_prop(node, propname, buf, len) != -1)) {
>> >> > +      return rv;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return -1;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_search_enc_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  pcell_t     *buf,
>> >> > +  size_t       len
>> >> > +)
>> >> > +{
>> >> > +  size_t rv;
>> >> > +
>> >> > +  for (; node != 0; node = rtems_ofw_parent(node)) {
>> >> > +    if ((rv = rtems_ofw_get_enc_prop(node, propname, buf, len) !=
>> -1)) {
>> >> > +      return rv;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return -1;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_prop_alloc(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void       **buf
>> >> > +)
>> >> > +{
>> >> > +  size_t len;
>> >> > +
>> >> > +  *buf = NULL;
>> >> > +  if ((len = rtems_ofw_get_prop_len(node, propname)) == -1) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  if (len > 0) {
>> >> > +    *buf = malloc(len);
>> >> > +
>> >> > +    if (rtems_ofw_get_prop(node, propname, *buf, len) == -1) {
>> >> > +      rtems_ofw_free(buf);
>> >> > +      *buf = NULL;
>> >> > +      return -1;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return len;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_prop_alloc_multi(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  int          elsz,
>> >> > +  void       **buf
>> >> > +)
>> >> > +{
>> >> > +  size_t len;
>> >> > +
>> >> > +  *buf = NULL;
>> >> > +  if ((len = rtems_ofw_get_prop_len(node, propname)) == -1 ||
>> >> > +      (len % elsz != 0)) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  if (len > 0) {
>> >> > +    *buf = malloc(len);
>> >> > +
>> >> > +    if (rtems_ofw_get_prop(node, propname, *buf, len) == -1) {
>> >> > +      rtems_ofw_free(buf);
>> >> > +      *buf = NULL;
>> >> > +      return -1;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return (len / elsz);
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_enc_prop_alloc(
>> >> > +  phandle_t    node,
>> >> > +  const char  *propname,
>> >> > +  void       **buf
>> >> > +)
>> >> > +{
>> >> > +  size_t len;
>> >> > +
>> >> > +  *buf = NULL;
>> >> > +  if ((len = rtems_ofw_get_prop_len(node, propname)) == -1) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  if (len > 0) {
>> >> > +    *buf = malloc(len);
>> >> > +
>> >> > +    if (rtems_ofw_get_enc_prop(node, propname, *buf, len) == -1) {
>> >> > +      rtems_ofw_free(buf);
>> >> > +      *buf = NULL;
>> >> > +      return -1;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return len;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_get_enc_prop_alloc_multi(
>> >> > +  phandle_t     node,
>> >> > +  const char   *propname,
>> >> > +  int           elsz,
>> >> > +  void        **buf
>> >> > +)
>> >> > +{
>> >> > +  size_t len;
>> >> > +
>> >> > +  *buf = NULL;
>> >> > +  if ((len = rtems_ofw_get_prop_len(node, propname)) == -1 ||
>> >> > +      (len % elsz != 0)) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  if (len > 0) {
>> >> > +    *buf = malloc(len);
>> >> > +
>> >> > +    if (rtems_ofw_get_enc_prop(node, propname, *buf, len) == -1) {
>> >> > +      rtems_ofw_free(buf);
>> >> > +      *buf = NULL;
>> >> > +      return -1;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return (len / elsz);
>> >> > +}
>> >> > +
>> >> > +void rtems_ofw_free( void *buf )
>> >> > +{
>> >> > +  free(buf);
>> >> > +}
>> >> > +
>> >> > +int rtems_ofw_next_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *previous,
>> >> > +  char        *buf,
>> >> > +  size_t       len
>> >> > +)
>> >> > +{
>> >> > +  const void *name;
>> >> > +  const void *prop;
>> >> > +  int offset;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  if (offset < 0) {
>> >> > +    return -1;
>> >> > +  }
>> >> > +
>> >> > +  if (previous == NULL) {
>> >> > +    offset = fdt_first_property_offset(fdtp, offset);
>> >> > +  } else {
>> >> > +    fdt_for_each_property_offset(offset, fdtp, offset) {
>> >> > +      prop = fdt_getprop_by_offset(fdtp, offset, (const char
>> **)&name, NULL);
>> >> > +      if (prop == NULL)
>> >> > +        return -1;
>> >> > +
>> >> > +      if (strcmp(previous, name) != 0)
>> >> > +        continue;
>> >> > +
>> >> > +      offset = fdt_next_property_offset(fdtp, offset);
>> >> > +      break;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  if (offset < 0)
>> >> > +    return 0;
>> >> > +
>> >> > +  prop = fdt_getprop_by_offset(fdtp, offset, (const char **)&name,
>> &offset);
>> >> > +  if (prop == NULL)
>> >> > +    return -1;
>> >> > +
>> >> > +  strncpy(buf, name, len);
>> >> > +
>> >> > +  return 1;
>> >> > +}
>> >> > +
>> >> > +int rtems_ofw_set_prop(
>> >> > +  phandle_t    node,
>> >> > +  const char  *name,
>> >> > +  const void  *buf,
>> >> > +  size_t       len
>> >> > +)
>> >> > +{
>> >> > +  int offset;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  if (offset < 0)
>> >> > +    return -1;
>> >> > +
>> >> > +  if (fdt_setprop_inplace(fdtp, offset, name, buf, len) != 0)
>> >> > +    return (fdt_setprop(fdtp, offset, name, buf, len));
>> >> > +
>> >> > +  return 0;
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_find_device( const char *path )
>> >> > +{
>> >> > +  int offset;
>> >> > +
>> >> > +  offset = fdt_path_offset(fdtp, path);
>> >> > +  if (offset < 0)
>> >> > +    return -1;
>> >> > +
>> >> > +  return rtems_fdt_offset_to_phandle(offset);
>> >> > +}
>> >> > +
>> >> > +static phandle_t rtems_ofw_get_effective_phandle(
>> >> > +  phandle_t node,
>> >> > +  phandle_t xref
>> >> > +)
>> >> > +{
>> >> > +  phandle_t child;
>> >> > +  phandle_t ref;
>> >> > +
>> >> > +  for (child = rtems_ofw_child(node); child != 0; child =
>> rtems_ofw_peer(child)) {
>> >> > +    ref = rtems_ofw_get_effective_phandle(child, xref);
>> >> > +    if (ref != -1)
>> >> > +      return ref;
>> >> > +
>> >> > +    if (rtems_ofw_get_enc_prop(child, "phandle", &ref, sizeof(ref))
>> == -1 &&
>> >> > +        rtems_ofw_get_enc_prop(child, "ibm,phandle", &ref,
>> sizeof(ref)) == -1 &&
>> >> > +        rtems_ofw_get_enc_prop(child, "linux,phandle", &ref,
>> sizeof(ref)) == -1
>> >> > +    ) {
>> >> > +      continue;
>> >> > +    }
>> >> > +
>> >> > +    if (ref == xref)
>> >> > +      return child;
>> >> > +  }
>> >> > +
>> >> > +  return -1;
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_node_from_xref( phandle_t xref )
>> >> > +{
>> >> > +  phandle_t node;
>> >> > +
>> >> > +  if ((node = rtems_ofw_get_effective_phandle(rtems_ofw_peer(0),
>> xref)) == -1)
>> >> > +    return xref;
>> >> > +
>> >> > +  return node;
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_xref_from_node( phandle_t node )
>> >> > +{
>> >> > +  phandle_t ref;
>> >> > +
>> >> > +    if (rtems_ofw_get_enc_prop(node, "phandle", &ref, sizeof(ref))
>> == -1 &&
>> >> > +        rtems_ofw_get_enc_prop(node, "ibm,phandle", &ref,
>> sizeof(ref)) == -1 &&
>> >> > +        rtems_ofw_get_enc_prop(node, "linux,phandle", &ref,
>> sizeof(ref)) == -1)
>> >> > +    {
>> >> > +      return node;
>> >> > +    }
>> >> > +
>> >> > +    return ref;
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_instance_to_package( ihandle_t instance )
>> >> > +{
>> >> > +  return rtems_ofw_node_from_xref(instance);
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_package_to_path(
>> >> > +  phandle_t   node,
>> >> > +  char       *buf,
>> >> > +  size_t      len
>> >> > +)
>> >> > +{
>> >> > +  int offset;
>> >> > +  int rv;
>> >> > +
>> >> > +  offset = rtems_fdt_phandle_to_offset(node);
>> >> > +
>> >> > +  rv = fdt_get_path(fdtp, offset, buf, len);
>> >> > +  if (rv != 0)
>> >> > +    return -1;
>> >> > +
>> >> > +  return rv;
>> >> > +}
>> >> > +
>> >> > +size_t rtems_ofw_instance_to_path(
>> >> > +  ihandle_t  instance,
>> >> > +  char      *buf,
>> >> > +  size_t     len
>> >> > +)
>> >> > +{
>> >> > +  int offset;
>> >> > +  int rv;
>> >> > +
>> >> > +  offset = rtems_ofw_instance_to_package(instance);
>> >> > +  offset = rtems_fdt_phandle_to_offset(offset);
>> >> > +
>> >> > +  rv = fdt_get_path(fdtp, offset, buf, len);
>> >> > +  if (rv != 0)
>> >> > +    return -1;
>> >> > +
>> >> > +  return rv;
>> >> > +}
>> >> > +
>> >> > +int rtems_ofw_get_reg(
>> >> > +  phandle_t              node,
>> >> > +  rtems_ofw_memory_area *buf,
>> >> > +  size_t                 size
>> >> > +)
>> >> > +{
>> >> > +  int len;
>> >> > +  int offset;
>> >> > +  int nranges;
>> >> > +  int nregs;
>> >> > +  phandle_t parent;
>> >> > +  rtems_ofw_ranges range;
>> >> > +  const rtems_ofw_ranges *ptr;
>> >> > +
>> >> > +  len = rtems_ofw_get_enc_prop(node, "reg", (pcell_t *)buf, size);
>> >> > +  if (len <= 0) {
>> >> > +    return len;
>> >> > +  }
>> >> > +
>> >> > +  nregs = MIN(len, size) / sizeof(rtems_ofw_memory_area);
>> >> > +
>> >> > +  for (parent = rtems_ofw_parent(node); parent > 0;
>> >> > +      parent = rtems_ofw_parent(parent)) {
>> >> > +
>> >> > +    offset = rtems_fdt_phandle_to_offset(parent);
>> >> > +    ptr = fdt_getprop(fdtp, offset, "ranges", &len);
>> >> > +
>> >> > +    if (len < 0) {
>> >> > +      break;
>> >> > +    }
>> >> > +
>> >> > +    nranges = len / sizeof(rtems_ofw_ranges);
>> >> > +
>> >> > +    offset = 0;
>> >> > +    for (int i=0; i < nregs; i++) {
>> >> > +      for (int j=0; j < nranges; j++) {
>> >> > +
>> >> > +        range.parent_bus = fdt32_to_cpu(ptr[j].parent_bus);
>> >> > +        range.child_bus = fdt32_to_cpu(ptr[j].child_bus);
>> >> > +        range.size = fdt32_to_cpu(ptr[j].size);
>> >> > +
>> >> > +        if (buf[i].start >= range.child_bus &&
>> >> > +            buf[i].start < range.child_bus + range.size) {
>> >> > +          offset = range.parent_bus - range.child_bus;
>> >> > +          break;
>> >> > +        }
>> >> > +
>> >> > +      }
>> >> > +      buf[i].start += offset;
>> >> > +    }
>> >> > +  }
>> >> > +
>> >> > +  return nregs;
>> >> > +}
>> >> > +
>> >> > +int rtems_ofw_get_interrupts(
>> >> > +  phandle_t            node,
>> >> > +  rtems_vector_number *buf,
>> >> > +  size_t               size
>> >> > +)
>> >> > +{
>> >> > +  int rv;
>> >> > +
>> >> > +  rv = rtems_ofw_get_enc_prop(node, "interrupts", buf, size);
>> >> > +
>> >> > +  if (rv <= 0) {
>> >> > +    return rv;
>> >> > +  }
>> >> > +
>> >> > +  return MIN(size, rv) / sizeof(rtems_vector_number);
>> >> > +}
>> >> > +
>> >> > +bool rtems_ofw_node_status( phandle_t node )
>> >> > +{
>> >> > +  int len;
>> >> > +  const char buf[10];
>> >> > +
>> >> > +  len = rtems_ofw_get_prop(node, "status", &buf[0], sizeof(buf));
>> >> > +  if ((len == -1) ||
>> >> > +      (strncmp(buf, "okay", MIN(5, len)) == 0) ||
>> >> > +      (strncmp(buf, "ok", MIN(3, len)) == 0)) {
>> >> > +      return true;
>> >> > +  }
>> >> > +
>> >> > +  return false;
>> >> > +}
>> >> > +
>> >> > +phandle_t rtems_ofw_find_device_by_compat( const char *compat )
>> >> > +{
>> >> > +  int offset;
>> >> > +
>> >> > +  offset = fdt_node_offset_by_compatible(fdtp, -1, compat);
>> >> > +  return rtems_fdt_offset_to_phandle(offset);
>> >> > +}
>> >> > diff --git a/spec/build/bsps/obj.yml b/spec/build/bsps/obj.yml
>> >> > index 8809238057..141ba25f5e 100644
>> >> > --- a/spec/build/bsps/obj.yml
>> >> > +++ b/spec/build/bsps/obj.yml
>> >> > @@ -24,6 +24,9 @@ install:
>> >> >    - bsps/include/bsp/u-boot.h
>> >> >    - bsps/include/bsp/uart-output-char.h
>> >> >    - bsps/include/bsp/utility.h
>> >> > +- destination: ${BSP_INCLUDEDIR}/ofw
>> >> > +  source:
>> >> > +  - bsps/include/ofw/ofw.h
>> >> >  - destination: ${BSP_INCLUDEDIR}/libchip
>> >> >    source:
>> >> >    - bsps/include/libchip/am29lv160.h
>> >> > @@ -104,4 +107,5 @@ source:
>> >> >  - bsps/shared/dev/serial/z85c30_reg.c
>> >> >  - bsps/shared/start/bootcard.c
>> >> >  - bsps/shared/rtems-version.c
>> >> > +- bsps/shared/ofw/ofw.c
>> >> >  type: build
>> >> > --
>> >> > 2.17.1
>> >> >
>>
>
-------------- next part --------------
An HTML attachment was scrubbed...
URL: <http://lists.rtems.org/pipermail/devel/attachments/20200824/2b1435a6/attachment-0001.html>


More information about the devel mailing list