125b3c049e70834cf33790a28643ab058b507b35cBen Cheng/* Align section. 225b3c049e70834cf33790a28643ab058b507b35cBen Cheng Copyright (C) 2002, 2005 Red Hat, Inc. 325b3c049e70834cf33790a28643ab058b507b35cBen Cheng This file is part of Red Hat elfutils. 425b3c049e70834cf33790a28643ab058b507b35cBen Cheng Written by Ulrich Drepper <drepper@redhat.com>, 2002. 525b3c049e70834cf33790a28643ab058b507b35cBen Cheng 625b3c049e70834cf33790a28643ab058b507b35cBen Cheng Red Hat elfutils is free software; you can redistribute it and/or modify 725b3c049e70834cf33790a28643ab058b507b35cBen Cheng it under the terms of the GNU General Public License as published by the 825b3c049e70834cf33790a28643ab058b507b35cBen Cheng Free Software Foundation; version 2 of the License. 925b3c049e70834cf33790a28643ab058b507b35cBen Cheng 1025b3c049e70834cf33790a28643ab058b507b35cBen Cheng Red Hat elfutils is distributed in the hope that it will be useful, but 1125b3c049e70834cf33790a28643ab058b507b35cBen Cheng WITHOUT ANY WARRANTY; without even the implied warranty of 1225b3c049e70834cf33790a28643ab058b507b35cBen Cheng MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 1325b3c049e70834cf33790a28643ab058b507b35cBen Cheng General Public License for more details. 1425b3c049e70834cf33790a28643ab058b507b35cBen Cheng 1525b3c049e70834cf33790a28643ab058b507b35cBen Cheng You should have received a copy of the GNU General Public License along 1625b3c049e70834cf33790a28643ab058b507b35cBen Cheng with Red Hat elfutils; if not, write to the Free Software Foundation, 1725b3c049e70834cf33790a28643ab058b507b35cBen Cheng Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301 USA. 1825b3c049e70834cf33790a28643ab058b507b35cBen Cheng 1925b3c049e70834cf33790a28643ab058b507b35cBen Cheng Red Hat elfutils is an included package of the Open Invention Network. 2025b3c049e70834cf33790a28643ab058b507b35cBen Cheng An included package of the Open Invention Network is a package for which 2125b3c049e70834cf33790a28643ab058b507b35cBen Cheng Open Invention Network licensees cross-license their patents. No patent 2225b3c049e70834cf33790a28643ab058b507b35cBen Cheng license is granted, either expressly or impliedly, by designation as an 2325b3c049e70834cf33790a28643ab058b507b35cBen Cheng included package. Should you wish to participate in the Open Invention 2425b3c049e70834cf33790a28643ab058b507b35cBen Cheng Network licensing program, please visit www.openinventionnetwork.com 2525b3c049e70834cf33790a28643ab058b507b35cBen Cheng <http://www.openinventionnetwork.com>. */ 2625b3c049e70834cf33790a28643ab058b507b35cBen Cheng 2725b3c049e70834cf33790a28643ab058b507b35cBen Cheng#ifdef HAVE_CONFIG_H 2825b3c049e70834cf33790a28643ab058b507b35cBen Cheng# include <config.h> 2925b3c049e70834cf33790a28643ab058b507b35cBen Cheng#endif 3025b3c049e70834cf33790a28643ab058b507b35cBen Cheng 3125b3c049e70834cf33790a28643ab058b507b35cBen Cheng#include <inttypes.h> 3225b3c049e70834cf33790a28643ab058b507b35cBen Cheng#include <stdlib.h> 3325b3c049e70834cf33790a28643ab058b507b35cBen Cheng#include <sys/param.h> 3425b3c049e70834cf33790a28643ab058b507b35cBen Cheng 3525b3c049e70834cf33790a28643ab058b507b35cBen Cheng#include <libasmP.h> 3625b3c049e70834cf33790a28643ab058b507b35cBen Cheng#include <system.h> 3725b3c049e70834cf33790a28643ab058b507b35cBen Cheng 3825b3c049e70834cf33790a28643ab058b507b35cBen Cheng 3925b3c049e70834cf33790a28643ab058b507b35cBen Chengint 4025b3c049e70834cf33790a28643ab058b507b35cBen Chengasm_align (asmscn, value) 4125b3c049e70834cf33790a28643ab058b507b35cBen Cheng AsmScn_t *asmscn; 4225b3c049e70834cf33790a28643ab058b507b35cBen Cheng GElf_Word value; 4325b3c049e70834cf33790a28643ab058b507b35cBen Cheng{ 4425b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn == NULL) 4525b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* An earlier error. */ 4625b3c049e70834cf33790a28643ab058b507b35cBen Cheng return -1; 4725b3c049e70834cf33790a28643ab058b507b35cBen Cheng 4825b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* The alignment value must be a power of two. */ 4925b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (unlikely (! powerof2 (value))) 5025b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 5125b3c049e70834cf33790a28643ab058b507b35cBen Cheng __libasm_seterrno (ASM_E_INVALID); 5225b3c049e70834cf33790a28643ab058b507b35cBen Cheng return -1; 5325b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 5425b3c049e70834cf33790a28643ab058b507b35cBen Cheng 5525b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (unlikely (asmscn->ctx->textp)) 5625b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 5725b3c049e70834cf33790a28643ab058b507b35cBen Cheng fprintf (asmscn->ctx->out.file, "\t.align %" PRId32 ", ", 5825b3c049e70834cf33790a28643ab058b507b35cBen Cheng (int32_t) value); 5925b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->pattern->len == 1) 6025b3c049e70834cf33790a28643ab058b507b35cBen Cheng fprintf (asmscn->ctx->out.file, "%02hhx\n", asmscn->pattern->bytes[0]); 6125b3c049e70834cf33790a28643ab058b507b35cBen Cheng else 6225b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 6325b3c049e70834cf33790a28643ab058b507b35cBen Cheng fputc_unlocked ('"', asmscn->ctx->out.file); 6425b3c049e70834cf33790a28643ab058b507b35cBen Cheng 6525b3c049e70834cf33790a28643ab058b507b35cBen Cheng for (size_t cnt = 0; cnt < asmscn->pattern->len; ++cnt) 6625b3c049e70834cf33790a28643ab058b507b35cBen Cheng fprintf (asmscn->ctx->out.file, "\\x%02hhx", 6725b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->pattern->bytes[cnt]); 6825b3c049e70834cf33790a28643ab058b507b35cBen Cheng 6925b3c049e70834cf33790a28643ab058b507b35cBen Cheng fputs_unlocked ("\"\n", asmscn->ctx->out.file); 7025b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 7125b3c049e70834cf33790a28643ab058b507b35cBen Cheng return 0; 7225b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 7325b3c049e70834cf33790a28643ab058b507b35cBen Cheng 7425b3c049e70834cf33790a28643ab058b507b35cBen Cheng rwlock_wrlock (asmscn->ctx->lock); 7525b3c049e70834cf33790a28643ab058b507b35cBen Cheng 7625b3c049e70834cf33790a28643ab058b507b35cBen Cheng int result = 0; 7725b3c049e70834cf33790a28643ab058b507b35cBen Cheng 7825b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Fillbytes necessary? */ 7925b3c049e70834cf33790a28643ab058b507b35cBen Cheng if ((asmscn->offset & (value - 1)) != 0) 8025b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 8125b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Add fillbytes. */ 8225b3c049e70834cf33790a28643ab058b507b35cBen Cheng size_t cnt = value - (asmscn->offset & (value - 1)); 8325b3c049e70834cf33790a28643ab058b507b35cBen Cheng 8425b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Ensure there is enough room to add the fill bytes. */ 8525b3c049e70834cf33790a28643ab058b507b35cBen Cheng result = __libasm_ensure_section_space (asmscn, cnt); 8625b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (result != 0) 8725b3c049e70834cf33790a28643ab058b507b35cBen Cheng goto out; 8825b3c049e70834cf33790a28643ab058b507b35cBen Cheng 8925b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Fill in the bytes. We align the pattern according to the 9025b3c049e70834cf33790a28643ab058b507b35cBen Cheng current offset. */ 9125b3c049e70834cf33790a28643ab058b507b35cBen Cheng size_t byteptr = asmscn->offset % asmscn->pattern->len; 9225b3c049e70834cf33790a28643ab058b507b35cBen Cheng 9325b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Update the total size. */ 9425b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->offset += cnt; 9525b3c049e70834cf33790a28643ab058b507b35cBen Cheng 9625b3c049e70834cf33790a28643ab058b507b35cBen Cheng do 9725b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 9825b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->content->data[asmscn->content->len++] 9925b3c049e70834cf33790a28643ab058b507b35cBen Cheng = asmscn->pattern->bytes[byteptr++]; 10025b3c049e70834cf33790a28643ab058b507b35cBen Cheng 10125b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (byteptr == asmscn->pattern->len) 10225b3c049e70834cf33790a28643ab058b507b35cBen Cheng byteptr = 0; 10325b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 10425b3c049e70834cf33790a28643ab058b507b35cBen Cheng while (--cnt > 0); 10525b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 10625b3c049e70834cf33790a28643ab058b507b35cBen Cheng 10725b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Remember the maximum alignment for this subsection. */ 10825b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->max_align < value) 10925b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 11025b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->max_align = value; 11125b3c049e70834cf33790a28643ab058b507b35cBen Cheng 11225b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Update the parent as well (if it exists). */ 11325b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->subsection_id != 0) 11425b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 11525b3c049e70834cf33790a28643ab058b507b35cBen Cheng rwlock_wrlock (asmscn->data.up->ctx->lock); 11625b3c049e70834cf33790a28643ab058b507b35cBen Cheng 11725b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->data.up->max_align < value) 11825b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->data.up->max_align = value; 11925b3c049e70834cf33790a28643ab058b507b35cBen Cheng 12025b3c049e70834cf33790a28643ab058b507b35cBen Cheng rwlock_unlock (asmscn->data.up->ctx->lock); 12125b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 12225b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 12325b3c049e70834cf33790a28643ab058b507b35cBen Cheng 12425b3c049e70834cf33790a28643ab058b507b35cBen Cheng out: 12525b3c049e70834cf33790a28643ab058b507b35cBen Cheng rwlock_unlock (asmscn->ctx->lock); 12625b3c049e70834cf33790a28643ab058b507b35cBen Cheng 12725b3c049e70834cf33790a28643ab058b507b35cBen Cheng return result; 12825b3c049e70834cf33790a28643ab058b507b35cBen Cheng} 12925b3c049e70834cf33790a28643ab058b507b35cBen Cheng 13025b3c049e70834cf33790a28643ab058b507b35cBen Cheng 13125b3c049e70834cf33790a28643ab058b507b35cBen Cheng/* Ensure there are at least LEN bytes available in the output buffer 13225b3c049e70834cf33790a28643ab058b507b35cBen Cheng for ASMSCN. */ 13325b3c049e70834cf33790a28643ab058b507b35cBen Chengint 13425b3c049e70834cf33790a28643ab058b507b35cBen Cheng__libasm_ensure_section_space (asmscn, len) 13525b3c049e70834cf33790a28643ab058b507b35cBen Cheng AsmScn_t *asmscn; 13625b3c049e70834cf33790a28643ab058b507b35cBen Cheng size_t len; 13725b3c049e70834cf33790a28643ab058b507b35cBen Cheng{ 13825b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* The blocks with the section content are kept in a circular 13925b3c049e70834cf33790a28643ab058b507b35cBen Cheng single-linked list. */ 14025b3c049e70834cf33790a28643ab058b507b35cBen Cheng size_t size; 14125b3c049e70834cf33790a28643ab058b507b35cBen Cheng 14225b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->content == NULL) 14325b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 14425b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* This is the first block. */ 14525b3c049e70834cf33790a28643ab058b507b35cBen Cheng size = MAX (2 * len, 960); 14625b3c049e70834cf33790a28643ab058b507b35cBen Cheng 14725b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->content = (struct AsmData *) malloc (sizeof (struct AsmData) 14825b3c049e70834cf33790a28643ab058b507b35cBen Cheng + size); 14925b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->content == NULL) 15025b3c049e70834cf33790a28643ab058b507b35cBen Cheng return -1; 15125b3c049e70834cf33790a28643ab058b507b35cBen Cheng 15225b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->content->next = asmscn->content; 15325b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 15425b3c049e70834cf33790a28643ab058b507b35cBen Cheng else 15525b3c049e70834cf33790a28643ab058b507b35cBen Cheng { 15625b3c049e70834cf33790a28643ab058b507b35cBen Cheng struct AsmData *newp; 15725b3c049e70834cf33790a28643ab058b507b35cBen Cheng 15825b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (asmscn->content->maxlen - asmscn->content->len >= len) 15925b3c049e70834cf33790a28643ab058b507b35cBen Cheng /* Nothing to do, there is enough space. */ 16025b3c049e70834cf33790a28643ab058b507b35cBen Cheng return 0; 16125b3c049e70834cf33790a28643ab058b507b35cBen Cheng 16225b3c049e70834cf33790a28643ab058b507b35cBen Cheng size = MAX (2 *len, MIN (32768, 2 * asmscn->offset)); 16325b3c049e70834cf33790a28643ab058b507b35cBen Cheng 16425b3c049e70834cf33790a28643ab058b507b35cBen Cheng newp = (struct AsmData *) malloc (sizeof (struct AsmData) + size); 16525b3c049e70834cf33790a28643ab058b507b35cBen Cheng if (newp == NULL) 16625b3c049e70834cf33790a28643ab058b507b35cBen Cheng return -1; 16725b3c049e70834cf33790a28643ab058b507b35cBen Cheng 16825b3c049e70834cf33790a28643ab058b507b35cBen Cheng newp->next = asmscn->content->next; 16925b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->content = asmscn->content->next = newp; 17025b3c049e70834cf33790a28643ab058b507b35cBen Cheng } 17125b3c049e70834cf33790a28643ab058b507b35cBen Cheng 17225b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->content->len = 0; 17325b3c049e70834cf33790a28643ab058b507b35cBen Cheng asmscn->content->maxlen = size; 17425b3c049e70834cf33790a28643ab058b507b35cBen Cheng 17525b3c049e70834cf33790a28643ab058b507b35cBen Cheng return 0; 17625b3c049e70834cf33790a28643ab058b507b35cBen Cheng} 177