cc26xx.c

Go to the documentation of this file.

// SPDX-License-Identifier: GPL-2.0-or-later
 
/***************************************************************************
 *   Copyright (C) 2017 by Texas Instruments, Inc.                         *
 ***************************************************************************/
 
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
 
#include "imp.h"
#include "cc26xx.h"
#include <helper/binarybuffer.h>
#include <helper/time_support.h>
#include <target/algorithm.h>
#include <target/armv7m.h>
#include <target/image.h>
 
#define FLASH_TIMEOUT 8000
 
struct cc26xx_bank {
    const char *family_name;
    uint32_t icepick_id;
    uint32_t user_id;
    uint32_t device_type;
    uint32_t sector_length;
    bool probed;
    struct working_area *working_area;
    struct armv7m_algorithm armv7m_info;
    const uint8_t *algo_code;
    uint32_t algo_size;
    uint32_t algo_working_size;
    uint32_t buffer_addr[2];
    uint32_t params_addr[2];
};
 
/* Flash helper algorithm for CC26x0 Chameleon targets */
static const uint8_t cc26x0_algo[] = {
#include "../../../contrib/loaders/flash/cc26xx/cc26x0_algo.inc"
};
 
/* Flash helper algorithm for CC26x2 Agama targets */
static const uint8_t cc26x2_algo[] = {
#include "../../../contrib/loaders/flash/cc26xx/cc26x2_algo.inc"
};
 
static int cc26xx_auto_probe(struct flash_bank *bank);
 
static uint32_t cc26xx_device_type(uint32_t icepick_id, uint32_t user_id)
{
    uint32_t device_type = 0;
 
    switch (icepick_id & ICEPICK_ID_MASK) {
        case CC26X0_ICEPICK_ID:
            device_type = CC26X0_TYPE;
            break;
        case CC26X1_ICEPICK_ID:
            device_type = CC26X1_TYPE;
            break;
        case CC13X0_ICEPICK_ID:
            device_type = CC13X0_TYPE;
            break;
        case CC13X2_CC26X2_ICEPICK_ID:
        default:
            if ((user_id & USER_ID_CC13_MASK) != 0)
                device_type = CC13X2_TYPE;
            else
                device_type = CC26X2_TYPE;
            break;
    }
 
    return device_type;
}
 
static uint32_t cc26xx_sector_length(uint32_t icepick_id)
{
    uint32_t sector_length;
 
    switch (icepick_id & ICEPICK_ID_MASK) {
        case CC26X0_ICEPICK_ID:
        case CC26X1_ICEPICK_ID:
        case CC13X0_ICEPICK_ID:
            /* Chameleon family device */
            sector_length = CC26X0_SECTOR_LENGTH;
            break;
        case CC13X2_CC26X2_ICEPICK_ID:
        default:
            /* Agama family device */
            sector_length = CC26X2_SECTOR_LENGTH;
            break;
    }
 
    return sector_length;
}
 
static int cc26xx_wait_algo_done(struct flash_bank *bank, uint32_t params_addr)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
 
    uint32_t status_addr = params_addr + CC26XX_STATUS_OFFSET;
    uint32_t status = CC26XX_BUFFER_FULL;
    long long start_ms;
    long long elapsed_ms;
 
    int retval = ERROR_OK;
 
    start_ms = timeval_ms();
    while (status == CC26XX_BUFFER_FULL) {
        retval = target_read_u32(target, status_addr, &status);
        if (retval != ERROR_OK)
            return retval;
 
        elapsed_ms = timeval_ms() - start_ms;
        if (elapsed_ms > 500)
            keep_alive();
        if (elapsed_ms > FLASH_TIMEOUT)
            break;
    };
 
    if (status != CC26XX_BUFFER_EMPTY) {
        LOG_ERROR("%s: Flash operation failed", cc26xx_bank->family_name);
        return ERROR_FAIL;
    }
 
    return ERROR_OK;
}
 
static int cc26xx_init(struct flash_bank *bank)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
 
    int retval;
 
    /* Make sure we've probed the flash to get the device and size */
    retval = cc26xx_auto_probe(bank);
    if (retval != ERROR_OK)
        return retval;
 
    /* Check for working area to use for flash helper algorithm */
    target_free_working_area(target, cc26xx_bank->working_area);
    cc26xx_bank->working_area = NULL;
 
    retval = target_alloc_working_area(target, cc26xx_bank->algo_working_size,
                &cc26xx_bank->working_area);
    if (retval != ERROR_OK)
        return retval;
 
    /* Confirm the defined working address is the area we need to use */
    if (cc26xx_bank->working_area->address != CC26XX_ALGO_BASE_ADDRESS)
        return ERROR_TARGET_RESOURCE_NOT_AVAILABLE;
 
    /* Write flash helper algorithm into target memory */
    retval = target_write_buffer(target, CC26XX_ALGO_BASE_ADDRESS,
                cc26xx_bank->algo_size, cc26xx_bank->algo_code);
    if (retval != ERROR_OK) {
        LOG_ERROR("%s: Failed to load flash helper algorithm",
            cc26xx_bank->family_name);
        target_free_working_area(target, cc26xx_bank->working_area);
        cc26xx_bank->working_area = NULL;
        return retval;
    }
 
    /* Initialize the ARMv7 specific info to run the algorithm */
    cc26xx_bank->armv7m_info.common_magic = ARMV7M_COMMON_MAGIC;
    cc26xx_bank->armv7m_info.core_mode = ARM_MODE_THREAD;
 
    /* Begin executing the flash helper algorithm */
    retval = target_start_algorithm(target, 0, NULL, 0, NULL,
                CC26XX_ALGO_BASE_ADDRESS, 0, &cc26xx_bank->armv7m_info);
    if (retval != ERROR_OK) {
        LOG_ERROR("%s: Failed to start flash helper algorithm",
            cc26xx_bank->family_name);
        target_free_working_area(target, cc26xx_bank->working_area);
        cc26xx_bank->working_area = NULL;
        return retval;
    }
 
    /*
     * At this point, the algorithm is running on the target and
     * ready to receive commands and data to flash the target
     */
 
    return retval;
}
 
static int cc26xx_quit(struct flash_bank *bank)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
 
    int retval;
 
    /* Regardless of the algo's status, attempt to halt the target */
    (void)target_halt(target);
 
    /* Now confirm target halted and clean up from flash helper algorithm */
    retval = target_wait_algorithm(target, 0, NULL, 0, NULL, 0, FLASH_TIMEOUT,
                &cc26xx_bank->armv7m_info);
 
    target_free_working_area(target, cc26xx_bank->working_area);
    cc26xx_bank->working_area = NULL;
 
    return retval;
}
 
static int cc26xx_mass_erase(struct flash_bank *bank)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
    struct cc26xx_algo_params algo_params;
 
    int retval;
 
    if (target->state != TARGET_HALTED) {
        LOG_ERROR("Target not halted");
        return ERROR_TARGET_NOT_HALTED;
    }
 
    retval = cc26xx_init(bank);
    if (retval != ERROR_OK)
        return retval;
 
    /* Initialize algorithm parameters */
    buf_set_u32(algo_params.address, 0, 32, 0);
    buf_set_u32(algo_params.length,  0, 32, 4);
    buf_set_u32(algo_params.command, 0, 32, CC26XX_CMD_ERASE_ALL);
    buf_set_u32(algo_params.status,  0, 32, CC26XX_BUFFER_FULL);
 
    /* Issue flash helper algorithm parameters for mass erase */
    retval = target_write_buffer(target, cc26xx_bank->params_addr[0],
                sizeof(algo_params), (uint8_t *)&algo_params);
 
    /* Wait for command to complete */
    if (retval == ERROR_OK)
        retval = cc26xx_wait_algo_done(bank, cc26xx_bank->params_addr[0]);
 
    /* Regardless of errors, try to close down algo */
    (void)cc26xx_quit(bank);
 
    return retval;
}
 
FLASH_BANK_COMMAND_HANDLER(cc26xx_flash_bank_command)
{
    struct cc26xx_bank *cc26xx_bank;
 
    if (CMD_ARGC < 6)
        return ERROR_COMMAND_SYNTAX_ERROR;
 
    cc26xx_bank = malloc(sizeof(struct cc26xx_bank));
    if (!cc26xx_bank)
        return ERROR_FAIL;
 
    /* Initialize private flash information */
    memset((void *)cc26xx_bank, 0x00, sizeof(struct cc26xx_bank));
    cc26xx_bank->family_name = "cc26xx";
    cc26xx_bank->device_type = CC26XX_NO_TYPE;
    cc26xx_bank->sector_length = 0x1000;
 
    /* Finish initialization of bank */
    bank->driver_priv = cc26xx_bank;
 
    return ERROR_OK;
}
 
static int cc26xx_erase(struct flash_bank *bank, unsigned int first,
        unsigned int last)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
    struct cc26xx_algo_params algo_params;
 
    uint32_t address;
    uint32_t length;
    int retval;
 
    if (target->state != TARGET_HALTED) {
        LOG_ERROR("Target not halted");
        return ERROR_TARGET_NOT_HALTED;
    }
 
    /* Do a mass erase if user requested all sectors of flash */
    if ((first == 0) && (last == (bank->num_sectors - 1))) {
        /* Request mass erase of flash */
        return cc26xx_mass_erase(bank);
    }
 
    address = first * cc26xx_bank->sector_length;
    length = (last - first + 1) * cc26xx_bank->sector_length;
 
    retval = cc26xx_init(bank);
    if (retval != ERROR_OK)
        return retval;
 
    /* Set up algorithm parameters for erase command */
    buf_set_u32(algo_params.address, 0, 32, address);
    buf_set_u32(algo_params.length,  0, 32, length);
    buf_set_u32(algo_params.command, 0, 32, CC26XX_CMD_ERASE_SECTORS);
    buf_set_u32(algo_params.status,  0, 32, CC26XX_BUFFER_FULL);
 
    /* Issue flash helper algorithm parameters for erase */
    retval = target_write_buffer(target, cc26xx_bank->params_addr[0],
                sizeof(algo_params), (uint8_t *)&algo_params);
 
    /* If no error, wait for erase to finish */
    if (retval == ERROR_OK)
        retval = cc26xx_wait_algo_done(bank, cc26xx_bank->params_addr[0]);
 
    /* Regardless of errors, try to close down algo */
    (void)cc26xx_quit(bank);
 
    return retval;
}
 
static int cc26xx_write(struct flash_bank *bank, const uint8_t *buffer,
    uint32_t offset, uint32_t count)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
    struct cc26xx_algo_params algo_params[2];
    uint32_t size = 0;
    long long start_ms;
    long long elapsed_ms;
    uint32_t address;
 
    uint32_t index;
    int retval;
 
    if (target->state != TARGET_HALTED) {
        LOG_ERROR("Target not halted");
        return ERROR_TARGET_NOT_HALTED;
    }
 
    retval = cc26xx_init(bank);
    if (retval != ERROR_OK)
        return retval;
 
    /* Initialize algorithm parameters to default values */
    buf_set_u32(algo_params[0].command, 0, 32, CC26XX_CMD_PROGRAM);
    buf_set_u32(algo_params[1].command, 0, 32, CC26XX_CMD_PROGRAM);
 
    /* Write requested data, ping-ponging between two buffers */
    index = 0;
    start_ms = timeval_ms();
    address = bank->base + offset;
    while (count > 0) {
 
        if (count > cc26xx_bank->sector_length)
            size = cc26xx_bank->sector_length;
        else
            size = count;
 
        /* Put next block of data to flash into buffer */
        retval = target_write_buffer(target, cc26xx_bank->buffer_addr[index],
                    size, buffer);
        if (retval != ERROR_OK) {
            LOG_ERROR("Unable to write data to target memory");
            break;
        }
 
        /* Update algo parameters for next block */
        buf_set_u32(algo_params[index].address, 0, 32, address);
        buf_set_u32(algo_params[index].length,  0, 32, size);
        buf_set_u32(algo_params[index].status,  0, 32, CC26XX_BUFFER_FULL);
 
        /* Issue flash helper algorithm parameters for block write */
        retval = target_write_buffer(target, cc26xx_bank->params_addr[index],
                    sizeof(algo_params[index]), (uint8_t *)&algo_params[index]);
        if (retval != ERROR_OK)
            break;
 
        /* Wait for next ping pong buffer to be ready */
        index ^= 1;
        retval = cc26xx_wait_algo_done(bank, cc26xx_bank->params_addr[index]);
        if (retval != ERROR_OK)
            break;
 
        count -= size;
        buffer += size;
        address += size;
 
        elapsed_ms = timeval_ms() - start_ms;
        if (elapsed_ms > 500)
            keep_alive();
    }
 
    /* If no error yet, wait for last buffer to finish */
    if (retval == ERROR_OK) {
        index ^= 1;
        retval = cc26xx_wait_algo_done(bank, cc26xx_bank->params_addr[index]);
    }
 
    /* Regardless of errors, try to close down algo */
    (void)cc26xx_quit(bank);
 
    return retval;
}
 
static int cc26xx_probe(struct flash_bank *bank)
{
    struct target *target = bank->target;
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
 
    uint32_t sector_length;
    uint32_t value;
    int num_sectors;
    int max_sectors;
 
    int retval;
 
    retval = target_read_u32(target, FCFG1_ICEPICK_ID, &value);
    if (retval != ERROR_OK)
        return retval;
    cc26xx_bank->icepick_id = value;
 
    retval = target_read_u32(target, FCFG1_USER_ID, &value);
    if (retval != ERROR_OK)
        return retval;
    cc26xx_bank->user_id = value;
 
    cc26xx_bank->device_type = cc26xx_device_type(cc26xx_bank->icepick_id,
        cc26xx_bank->user_id);
 
    sector_length = cc26xx_sector_length(cc26xx_bank->icepick_id);
 
    /* Set up appropriate flash helper algorithm */
    switch (cc26xx_bank->icepick_id & ICEPICK_ID_MASK) {
        case CC26X0_ICEPICK_ID:
        case CC26X1_ICEPICK_ID:
        case CC13X0_ICEPICK_ID:
            /* Chameleon family device */
            cc26xx_bank->algo_code = cc26x0_algo;
            cc26xx_bank->algo_size = sizeof(cc26x0_algo);
            cc26xx_bank->algo_working_size = CC26X0_WORKING_SIZE;
            cc26xx_bank->buffer_addr[0] = CC26X0_ALGO_BUFFER_0;
            cc26xx_bank->buffer_addr[1] = CC26X0_ALGO_BUFFER_1;
            cc26xx_bank->params_addr[0] = CC26X0_ALGO_PARAMS_0;
            cc26xx_bank->params_addr[1] = CC26X0_ALGO_PARAMS_1;
            max_sectors = CC26X0_MAX_SECTORS;
            break;
        case CC13X2_CC26X2_ICEPICK_ID:
        default:
            /* Agama family device */
            cc26xx_bank->algo_code = cc26x2_algo;
            cc26xx_bank->algo_size = sizeof(cc26x2_algo);
            cc26xx_bank->algo_working_size = CC26X2_WORKING_SIZE;
            cc26xx_bank->buffer_addr[0] = CC26X2_ALGO_BUFFER_0;
            cc26xx_bank->buffer_addr[1] = CC26X2_ALGO_BUFFER_1;
            cc26xx_bank->params_addr[0] = CC26X2_ALGO_PARAMS_0;
            cc26xx_bank->params_addr[1] = CC26X2_ALGO_PARAMS_1;
            max_sectors = CC26X2_MAX_SECTORS;
            break;
    }
 
    retval = target_read_u32(target, CC26XX_FLASH_SIZE_INFO, &value);
    if (retval != ERROR_OK)
        return retval;
    num_sectors = value & 0xff;
    if (num_sectors > max_sectors)
        num_sectors = max_sectors;
 
    bank->sectors = malloc(sizeof(struct flash_sector) * num_sectors);
    if (!bank->sectors)
        return ERROR_FAIL;
 
    bank->base = CC26XX_FLASH_BASE_ADDR;
    bank->num_sectors = num_sectors;
    bank->size = num_sectors * sector_length;
    bank->write_start_alignment = 0;
    bank->write_end_alignment = 0;
    cc26xx_bank->sector_length = sector_length;
 
    for (int i = 0; i < num_sectors; i++) {
        bank->sectors[i].offset = i * sector_length;
        bank->sectors[i].size = sector_length;
        bank->sectors[i].is_erased = -1;
        bank->sectors[i].is_protected = 0;
    }
 
    /* We've successfully determined the stats on the flash bank */
    cc26xx_bank->probed = true;
 
    /* If we fall through to here, then all went well */
 
    return ERROR_OK;
}
 
static int cc26xx_auto_probe(struct flash_bank *bank)
{
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
 
    int retval = ERROR_OK;
 
    if (!cc26xx_bank->probed)
        retval = cc26xx_probe(bank);
 
    return retval;
}
 
static int cc26xx_info(struct flash_bank *bank, struct command_invocation *cmd)
{
    struct cc26xx_bank *cc26xx_bank = bank->driver_priv;
    const char *device;
 
    switch (cc26xx_bank->device_type) {
        case CC26X0_TYPE:
            device = "CC26x0";
            break;
        case CC26X1_TYPE:
            device = "CC26x1";
            break;
        case CC13X0_TYPE:
            device = "CC13x0";
            break;
        case CC13X2_TYPE:
            device = "CC13x2";
            break;
        case CC26X2_TYPE:
            device = "CC26x2";
            break;
        case CC26XX_NO_TYPE:
        default:
            device = "Unrecognized";
            break;
    }
 
    command_print_sameline(cmd,
        "%s device: ICEPick ID 0x%08" PRIx32 ", USER ID 0x%08" PRIx32 "\n",
        device, cc26xx_bank->icepick_id, cc26xx_bank->user_id);
 
    return ERROR_OK;
}
 
const struct flash_driver cc26xx_flash = {
    .name = "cc26xx",
    .flash_bank_command = cc26xx_flash_bank_command,
    .erase = cc26xx_erase,
    .write = cc26xx_write,
    .read = default_flash_read,
    .probe = cc26xx_probe,
    .auto_probe = cc26xx_auto_probe,
    .erase_check = default_flash_blank_check,
    .info = cc26xx_info,
    .free_driver_priv = default_flash_free_driver_priv,
};