EmbeddedPkg: Apply uncrustify changes

[mirror_edk2.git] / EmbeddedPkg / Library / FdtLib / fdt_wip.c

/*\r
 * libfdt - Flat Device Tree manipulation\r
 * Copyright (C) 2006 David Gibson, IBM Corporation.\r
 *\r
 * libfdt is dual licensed: you can use it either under the terms of\r
 * the GPL, or the BSD license, at your option.\r
 *\r
 *  a) This library is free software; you can redistribute it and/or\r
 *     modify it under the terms of the GNU General Public License as\r
 *     published by the Free Software Foundation; either version 2 of the\r
 *     License, or (at your option) any later version.\r
 *\r
 *     This library is distributed in the hope that it will be useful,\r
 *     but WITHOUT ANY WARRANTY; without even the implied warranty of\r
 *     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the\r
 *     GNU General Public License for more details.\r
 *\r
 *     You should have received a copy of the GNU General Public\r
 *     License along with this library; if not, write to the Free\r
 *     Software Foundation, Inc., 51 Franklin St, Fifth Floor, Boston,\r
 *     MA 02110-1301 USA\r
 *\r
 * Alternatively,\r
 *\r
 *  b) Redistribution and use in source and binary forms, with or\r
 *     without modification, are permitted provided that the following\r
 *     conditions are met:\r
 *\r
 *     1. Redistributions of source code must retain the above\r
 *        copyright notice, this list of conditions and the following\r
 *        disclaimer.\r
 *     2. Redistributions in binary form must reproduce the above\r
 *        copyright notice, this list of conditions and the following\r
 *        disclaimer in the documentation and/or other materials\r
 *        provided with the distribution.\r
 *\r
 *     THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND\r
 *     CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES,\r
 *     INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF\r
 *     MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE\r
 *     DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR\r
 *     CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,\r
 *     SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT\r
 *     NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;\r
 *     LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)\r
 *     HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN\r
 *     CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR\r
 *     OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,\r
 *     EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.\r
 */\r
#include "libfdt_env.h"\r
\r
#include <fdt.h>\r
#include <libfdt.h>\r
\r
#include "libfdt_internal.h"\r
\r
int\r
fdt_setprop_inplace_namelen_partial (\r
  void        *fdt,\r
  int         nodeoffset,\r
  const char  *name,\r
  int         namelen,\r
  uint32_t    idx,\r
  const void  *val,\r
  int         len\r
  )\r
{\r
  void  *propval;\r
  int   proplen;\r
\r
  propval = fdt_getprop_namelen_w (\r
              fdt,\r
              nodeoffset,\r
              name,\r
              namelen,\r
              &proplen\r
              );\r
  if (!propval) {\r
    return proplen;\r
  }\r
\r
  if (proplen < (len + idx)) {\r
    return -FDT_ERR_NOSPACE;\r
  }\r
\r
  memcpy ((char *)propval + idx, val, len);\r
  return 0;\r
}\r
\r
int\r
fdt_setprop_inplace (\r
  void        *fdt,\r
  int         nodeoffset,\r
  const char  *name,\r
  const void  *val,\r
  int         len\r
  )\r
{\r
  const void  *propval;\r
  int         proplen;\r
\r
  propval = fdt_getprop (fdt, nodeoffset, name, &proplen);\r
  if (!propval) {\r
    return proplen;\r
  }\r
\r
  if (proplen != len) {\r
    return -FDT_ERR_NOSPACE;\r
  }\r
\r
  return fdt_setprop_inplace_namelen_partial (\r
           fdt,\r
           nodeoffset,\r
           name,\r
           strlen (name),\r
           0,\r
           val,\r
           len\r
           );\r
}\r
\r
static void\r
_fdt_nop_region (\r
  void  *start,\r
  int   len\r
  )\r
{\r
  fdt32_t  *p;\r
\r
  for (p = start; (char *)p < ((char *)start + len); p++) {\r
    *p = cpu_to_fdt32 (FDT_NOP);\r
  }\r
}\r
\r
int\r
fdt_nop_property (\r
  void        *fdt,\r
  int         nodeoffset,\r
  const char  *name\r
  )\r
{\r
  struct fdt_property  *prop;\r
  int                  len;\r
\r
  prop = fdt_get_property_w (fdt, nodeoffset, name, &len);\r
  if (!prop) {\r
    return len;\r
  }\r
\r
  _fdt_nop_region (prop, len + sizeof (*prop));\r
\r
  return 0;\r
}\r
\r
int\r
_fdt_node_end_offset (\r
  void  *fdt,\r
  int   offset\r
  )\r
{\r
  int  depth = 0;\r
\r
  while ((offset >= 0) && (depth >= 0)) {\r
    offset = fdt_next_node (fdt, offset, &depth);\r
  }\r
\r
  return offset;\r
}\r
\r
int\r
fdt_nop_node (\r
  void  *fdt,\r
  int   nodeoffset\r
  )\r
{\r
  int  endoffset;\r
\r
  endoffset = _fdt_node_end_offset (fdt, nodeoffset);\r
  if (endoffset < 0) {\r
    return endoffset;\r
  }\r
\r
  _fdt_nop_region (\r
    fdt_offset_ptr_w (fdt, nodeoffset, 0),\r
    endoffset - nodeoffset\r
    );\r
  return 0;\r
}\r