bootloader/apps/elftosb/common/StExecutableImage.cpp

/*
 * File:	StExecutableImage.cpp
 *
 * Copyright (c) Freescale Semiconductor, Inc. All rights reserved.
 * See included license file for license details.
 */

#include "StExecutableImage.h"
#include <stdexcept>
#include <algorithm>
#include <string.h>
#include <stdio.h>

StExecutableImage::StExecutableImage(int inAlignment)
    : m_alignment(inAlignment)
    , m_hasEntry(false)
    , m_entry(0)
{
}

//! Makes a duplicate of each memory region.
StExecutableImage::StExecutableImage(const StExecutableImage &inOther)
    : m_name(inOther.m_name)
    , m_alignment(inOther.m_alignment)
    , m_hasEntry(inOther.m_hasEntry)
    , m_entry(inOther.m_entry)
    , m_filters(inOther.m_filters)
{
    const_iterator it = inOther.getRegionBegin();
    for (; it != inOther.getRegionEnd(); ++it)
    {
        const MemoryRegion &region = *it;

        MemoryRegion regionCopy(region);
        if (region.m_type == FILL_REGION && region.m_data != NULL)
        {
            regionCopy.m_data = new uint8_t[region.m_length];
            memcpy(regionCopy.m_data, region.m_data, region.m_length);
        }

        m_image.push_back(regionCopy);
    }
}

//! Disposes of memory allocated for each region.
StExecutableImage::~StExecutableImage()
{
    MemoryRegionList::iterator it;
    for (it = m_image.begin(); it != m_image.end(); ++it)
    {
        if (it->m_data)
        {
            delete[] it->m_data;
            it->m_data = NULL;
        }
    }
}

//! A copy of \a inName is made, so the original may be disposed of by the caller
//! after this method returns.
void StExecutableImage::setName(const std::string &inName)
{
    m_name = inName;
}

std::string StExecutableImage::getName() const
{
    return m_name;
}

// The region is added with read and write flags set.
//! \exception std::runtime_error will be thrown if the new overlaps an
//!		existing region.
void StExecutableImage::addFillRegion(uint32_t inAddress, unsigned inLength)
{
    MemoryRegion region;
    region.m_type = FILL_REGION;
    region.m_address = inAddress;
    region.m_data = NULL;
    region.m_length = inLength;
    region.m_flags = REGION_RW_FLAG;

    insertOrMergeRegion(region);
}

//! A copy of \a inData is made before returning. The copy will be deleted when
//! the executable image is destructed. Currently, the text region is created with
//! read, write, and executable flags set.
//! \exception std::runtime_error will be thrown if the new overlaps an
//!		existing region.
//! \exception std::bad_alloc is thrown if memory for the copy of \a inData
//!		cannot be allocated.
void StExecutableImage::addTextRegion(uint32_t inAddress, const uint8_t *inData, unsigned inLength)
{
    MemoryRegion region;
    region.m_type = TEXT_REGION;
    region.m_address = inAddress;
    region.m_flags = REGION_RW_FLAG | REGION_EXEC_FLAG;

    // copy the data
    region.m_data = new uint8_t[inLength];
    region.m_length = inLength;
    memcpy(region.m_data, inData, inLength);

    insertOrMergeRegion(region);
}

//! \exception std::out_of_range is thrown if \a inIndex is out of range.
//!
const StExecutableImage::MemoryRegion &StExecutableImage::getRegionAtIndex(unsigned inIndex) const
{
    // check bounds
    if (inIndex >= m_image.size())
        throw std::out_of_range("inIndex");

    // find region by index
    MemoryRegionList::const_iterator it = m_image.begin();
    unsigned i = 0;
    for (; it != m_image.end(); ++it, ++i)
    {
        if (i == inIndex)
            break;
    }
    return *it;
}

//! The list of address filters is kept sorted as filters are added.
//!
void StExecutableImage::addAddressFilter(const AddressFilter &filter)
{
    m_filters.push_back(filter);
    m_filters.sort();
}

//!
void StExecutableImage::clearAddressFilters()
{
    m_filters.clear();
}

//! \exception StExecutableImage::address_filter_exception Raised when a filter
//!     with the type #ADDR_FILTER_ERROR or #ADDR_FILTER_WARNING is matched.
//!
//! \todo Build a list of all matching filters and then execute them at once.
//!     For the warning and error filters, a single exception should be raised
//!     that identifies all the overlapping errors. Currently the user will only
//!     see the first (lowest address) overlap.
void StExecutableImage::applyAddressFilters()
{
restart_loops:
    // Iterate over filters.
    AddressFilterList::const_iterator fit = m_filters.begin();
    for (; fit != m_filters.end(); ++fit)
    {
        const AddressFilter &filter = *fit;

        // Iterator over regions.
        MemoryRegionList::iterator rit = m_image.begin();
        for (; rit != m_image.end(); ++rit)
        {
            MemoryRegion &region = *rit;

            if (filter.matchesMemoryRegion(region))
            {
                switch (filter.m_action)
                {
                    case ADDR_FILTER_NONE:
                        // Do nothing.
                        break;

                    case ADDR_FILTER_ERROR:
                        // throw error exception
                        throw address_filter_exception(true, m_name, filter);
                        break;

                    case ADDR_FILTER_WARNING:
                        // throw warning exception
                        throw address_filter_exception(false, m_name, filter);
                        break;

                    case ADDR_FILTER_CROP:
                        // Delete the offending portion of the region and restart
                        // the iteration loops.
                        cropRegionToFilter(region, filter);
                        goto restart_loops;
                        break;
                }
            }
        }
    }
}

//! There are several possible cases here:
//!     - No overlap at all. Nothing is done.
//!
//!     - All of the memory region is matched by the \a filter. The region is
//!         removed from #StExecutableImage::m_image and its data memory freed.
//!
//!     - The remaining portion of the region is one contiguous chunk. In this
//!         case, \a region is simply modified.
//!
//!     - The region is split in the middle by the filter. The original \a region
//!         is modified to match the first remaining chunk. And a new #StExecutableImage::MemoryRegion
//!         instance is created to hold the other leftover piece.
void StExecutableImage::cropRegionToFilter(MemoryRegion &region, const AddressFilter &filter)
{
    uint32_t firstByte = region.m_address;   // first byte occupied by this region
    uint32_t lastByte = region.endAddress(); // last used byte in this region

    // compute new address range
    uint32_t cropFrom = filter.m_fromAddress;
    if (cropFrom < firstByte)
    {
        cropFrom = firstByte;
    }

    uint32_t cropTo = filter.m_toAddress;
    if (cropTo > lastByte)
    {
        cropTo = lastByte;
    }

    // is there actually a match?
    if (cropFrom > filter.m_toAddress || cropTo < filter.m_fromAddress)
    {
        // nothing to do, so bail
        return;
    }

    printf("Deleting region 0x%08x-0x%08x\n", cropFrom, cropTo);

    // handle if the entire region is to be deleted
    if (cropFrom == firstByte && cropTo == lastByte)
    {
        delete[] region.m_data;
        region.m_data = NULL;
        m_image.remove(region);
    }

    // there is at least a little of the original region remaining
    uint32_t newLength = cropTo - cropFrom + 1;
    uint32_t leftoverLength = lastByte - cropTo;
    uint8_t *oldData = region.m_data;

    // update the region
    region.m_address = cropFrom;
    region.m_length = newLength;

    // crop data buffer for text regions
    if (region.m_type == TEXT_REGION && oldData)
    {
        region.m_data = new uint8_t[newLength];
        memcpy(region.m_data, &oldData[cropFrom - firstByte], newLength);

        // dispose of old data
        delete[] oldData;
    }

    // create a new region for any part of the original region that was past
    // the crop to address. this will happen if the filter range falls in the
    // middle of the region.
    if (leftoverLength)
    {
        MemoryRegion newRegion;
        newRegion.m_type = region.m_type;
        newRegion.m_flags = region.m_flags;
        newRegion.m_address = cropTo + 1;
        newRegion.m_length = leftoverLength;

        if (region.m_type == TEXT_REGION && oldData)
        {
            newRegion.m_data = new uint8_t[leftoverLength];
            memcpy(newRegion.m_data, &oldData[cropTo - firstByte + 1], leftoverLength);
        }

        insertOrMergeRegion(newRegion);
    }
}

//! \exception std::runtime_error will be thrown if \a inRegion overlaps an
//!		existing region.
//!
//! \todo Need to investigate if we can use the STL sort algorithm at all. Even
//!     though we're doing merges too, we could sort first then examine the list
//!     for merges.
void StExecutableImage::insertOrMergeRegion(MemoryRegion &inRegion)
{
    uint32_t newStart = inRegion.m_address;
    uint32_t newEnd = newStart + inRegion.m_length;

    MemoryRegionList::iterator it = m_image.begin();
    //	MemoryRegionList::iterator sortedPosition = m_image.begin();
    for (; it != m_image.end(); ++it)
    {
        MemoryRegion &region = *it;
        uint32_t thisStart = region.m_address;
        uint32_t thisEnd = thisStart + region.m_length;

        // keep track of where to insert it to retain sort order
        if (thisStart >= newEnd)
        {
            break;
        }

        // region types and flags must match in order to merge
        if (region.m_type == inRegion.m_type && region.m_flags == inRegion.m_flags)
        {
            if (newStart == thisEnd || newEnd == thisStart)
            {
                mergeRegions(region, inRegion);
                return;
            }
            else if ((newStart >= thisStart && newStart < thisEnd) || (newEnd >= thisStart && newEnd < thisEnd))
            {
                throw std::runtime_error("new region overlaps existing region");
            }
        }
    }

    // not merged, so just insert it in the sorted position
    m_image.insert(it, inRegion);
}

//! Extends \a inNewRegion to include the data in \a inOldRegion. It is
//! assumed that the two regions are compatible. The new region may come either
//! before or after the old region in memory. Note that while the two regions
//! don't necessarily have to be touching, it's probably a good idea. That's
//! because any data between the regions will be set to 0.
//!
//! For TEXT_REGION types, the two original regions will have their data deleted
//! during the merge. Thus, this method is not safe if any outside callers may
//! be accessing the region's data.
void StExecutableImage::mergeRegions(MemoryRegion &inOldRegion, MemoryRegion &inNewRegion)
{
    bool isOldBefore = inOldRegion.m_address < inNewRegion.m_address;
    uint32_t oldEnd = inOldRegion.m_address + inOldRegion.m_length;
    uint32_t newEnd = inNewRegion.m_address + inNewRegion.m_length;

    switch (inOldRegion.m_type)
    {
        case TEXT_REGION:
        {
            // calculate new length
            unsigned newLength;
            if (isOldBefore)
            {
                newLength = newEnd - inOldRegion.m_address;
            }
            else
            {
                newLength = oldEnd - inNewRegion.m_address;
            }

            // alloc memory
            uint8_t *newData = new uint8_t[newLength];
            memset(newData, 0, newLength);

            // copy data from the two regions into new block
            if (isOldBefore)
            {
                memcpy(newData, inOldRegion.m_data, inOldRegion.m_length);
                memcpy(&newData[newLength - inNewRegion.m_length], inNewRegion.m_data, inNewRegion.m_length);
            }
            else
            {
                memcpy(newData, inNewRegion.m_data, inNewRegion.m_length);
                memcpy(&newData[newLength - inOldRegion.m_length], inOldRegion.m_data, inOldRegion.m_length);

                inOldRegion.m_address = inNewRegion.m_address;
            }

            // replace old region's data
            delete[] inOldRegion.m_data;
            inOldRegion.m_data = newData;
            inOldRegion.m_length = newLength;

            // delete new region's data
            delete[] inNewRegion.m_data;
            inNewRegion.m_data = NULL;
            break;
        }

        case FILL_REGION:
        {
            if (isOldBefore)
            {
                inOldRegion.m_length = newEnd - inOldRegion.m_address;
            }
            else
            {
                inOldRegion.m_length = oldEnd - inNewRegion.m_address;
                inOldRegion.m_address = inNewRegion.m_address;
            }
            break;
        }
    }
}

//! Used when we remove a region from the region list by value. Because this
//! operator compares the #m_data member, it will only return true for either an
//! exact copy or a reference to the original.
bool StExecutableImage::MemoryRegion::operator==(const MemoryRegion &other) const
{
    return (m_type == other.m_type) && (m_address == other.m_address) && (m_length == other.m_length) &&
           (m_flags == other.m_flags) && (m_data == other.m_data);
}

//! Returns true if the address filter overlaps \a region.
bool StExecutableImage::AddressFilter::matchesMemoryRegion(const MemoryRegion &region) const
{
    uint32_t firstByte = region.m_address;   // first byte occupied by this region
    uint32_t lastByte = region.endAddress(); // last used byte in this region
    return (firstByte >= m_fromAddress && firstByte <= m_toAddress) ||
           (lastByte >= m_fromAddress && lastByte <= m_toAddress);
}

//! The comparison does \em not take the action into account. It only looks at the
//! priority and address ranges of each filter. Priority is considered only if the two
//! filters overlap. Lower priority filters will come after higher priority ones.
//!
//! \retval -1 This filter is less than filter \a b.
//! \retval 0 This filter is equal to filter \a b.
//! \retval 1 This filter is greater than filter \a b.
int StExecutableImage::AddressFilter::compare(const AddressFilter &other) const
{
    if (m_priority != other.m_priority &&
        ((m_fromAddress >= other.m_fromAddress && m_fromAddress <= other.m_toAddress) ||
         (m_toAddress >= other.m_fromAddress && m_toAddress <= other.m_toAddress)))
    {
        // we know the priorities are not equal
        if (m_priority > other.m_priority)
        {
            return -1;
        }
        else
        {
            return 1;
        }
    }

    if (m_fromAddress == other.m_fromAddress)
    {
        if (m_toAddress == other.m_toAddress)
        {
            return 0;
        }
        else if (m_toAddress < other.m_toAddress)
        {
            return -1;
        }
        else
        {
            return 1;
        }
    }
    else if (m_fromAddress < other.m_fromAddress)
    {
        return -1;
    }
    else
    {
        return 1;
    }
}