269 lines
7.8 KiB
C
269 lines
7.8 KiB
C
/***************************************************************************
|
|
* Copyright (C) 2006 by Anders Larsen *
|
|
* al@alarsen.net *
|
|
* *
|
|
* This program is free software; you can redistribute it and/or modify *
|
|
* it under the terms of the GNU General Public License as published by *
|
|
* the Free Software Foundation; either version 2 of the License, or *
|
|
* (at your option) any later version. *
|
|
* *
|
|
* This program is distributed in the hope that it will be useful, *
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
|
* GNU General Public License for more details. *
|
|
* *
|
|
* You should have received a copy of the GNU General Public License *
|
|
* along with this program; if not, write to the *
|
|
* Free Software Foundation, Inc., *
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. *
|
|
***************************************************************************/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <jtag/interface.h>
|
|
#include "bitbang.h"
|
|
|
|
#include <sys/mman.h>
|
|
|
|
/* AT91RM9200 */
|
|
#define AT91C_BASE_SYS (0xfffff000)
|
|
|
|
/* GPIO assignment */
|
|
#define PIOA (0 << 7)
|
|
#define PIOB (1 << 7)
|
|
#define PIOC (2 << 7)
|
|
#define PIOD (3 << 7)
|
|
|
|
#define PIO_PER (0) /* PIO enable */
|
|
#define PIO_OER (4) /* output enable */
|
|
#define PIO_ODR (5) /* output disable */
|
|
#define PIO_SODR (12) /* set output data */
|
|
#define PIO_CODR (13) /* clear output data */
|
|
#define PIO_PDSR (15) /* pin data status */
|
|
#define PIO_PPUER (25) /* pull-up enable */
|
|
|
|
#define NC (0) /* not connected */
|
|
#define P0 (1 << 0)
|
|
#define P1 (1 << 1)
|
|
#define P2 (1 << 2)
|
|
#define P3 (1 << 3)
|
|
#define P4 (1 << 4)
|
|
#define P5 (1 << 5)
|
|
#define P6 (1 << 6)
|
|
#define P7 (1 << 7)
|
|
#define P8 (1 << 8)
|
|
#define P9 (1 << 9)
|
|
#define P10 (1 << 10)
|
|
#define P11 (1 << 11)
|
|
#define P12 (1 << 12)
|
|
#define P13 (1 << 13)
|
|
#define P14 (1 << 14)
|
|
#define P15 (1 << 15)
|
|
#define P16 (1 << 16)
|
|
#define P17 (1 << 17)
|
|
#define P18 (1 << 18)
|
|
#define P19 (1 << 19)
|
|
#define P20 (1 << 20)
|
|
#define P21 (1 << 21)
|
|
#define P22 (1 << 22)
|
|
#define P23 (1 << 23)
|
|
#define P24 (1 << 24)
|
|
#define P25 (1 << 25)
|
|
#define P26 (1 << 26)
|
|
#define P27 (1 << 27)
|
|
#define P28 (1 << 28)
|
|
#define P29 (1 << 29)
|
|
#define P30 (1 << 30)
|
|
#define P31 (1 << 31)
|
|
|
|
struct device_t {
|
|
const char *name;
|
|
int TDO_PIO; /* PIO holding TDO */
|
|
uint32_t TDO_MASK; /* TDO bitmask */
|
|
int TRST_PIO; /* PIO holding TRST */
|
|
uint32_t TRST_MASK; /* TRST bitmask */
|
|
int TMS_PIO; /* PIO holding TMS */
|
|
uint32_t TMS_MASK; /* TMS bitmask */
|
|
int TCK_PIO; /* PIO holding TCK */
|
|
uint32_t TCK_MASK; /* TCK bitmask */
|
|
int TDI_PIO; /* PIO holding TDI */
|
|
uint32_t TDI_MASK; /* TDI bitmask */
|
|
int SRST_PIO; /* PIO holding SRST */
|
|
uint32_t SRST_MASK; /* SRST bitmask */
|
|
};
|
|
|
|
static const struct device_t devices[] = {
|
|
{ "rea_ecr", PIOD, P27, PIOA, NC, PIOD, P23, PIOD, P24, PIOD, P26, PIOC, P5 },
|
|
{ .name = NULL },
|
|
};
|
|
|
|
/* configuration */
|
|
static char *at91rm9200_device;
|
|
|
|
/* interface variables
|
|
*/
|
|
static const struct device_t *device;
|
|
static int dev_mem_fd;
|
|
static void *sys_controller;
|
|
static uint32_t *pio_base;
|
|
|
|
/* low level command set
|
|
*/
|
|
static int at91rm9200_read(void);
|
|
static void at91rm9200_write(int tck, int tms, int tdi);
|
|
static void at91rm9200_reset(int trst, int srst);
|
|
|
|
static int at91rm9200_init(void);
|
|
static int at91rm9200_quit(void);
|
|
|
|
static struct bitbang_interface at91rm9200_bitbang = {
|
|
.read = at91rm9200_read,
|
|
.write = at91rm9200_write,
|
|
.reset = at91rm9200_reset,
|
|
.blink = 0
|
|
};
|
|
|
|
static int at91rm9200_read(void)
|
|
{
|
|
return (pio_base[device->TDO_PIO + PIO_PDSR] & device->TDO_MASK) != 0;
|
|
}
|
|
|
|
static void at91rm9200_write(int tck, int tms, int tdi)
|
|
{
|
|
if (tck)
|
|
pio_base[device->TCK_PIO + PIO_SODR] = device->TCK_MASK;
|
|
else
|
|
pio_base[device->TCK_PIO + PIO_CODR] = device->TCK_MASK;
|
|
|
|
if (tms)
|
|
pio_base[device->TMS_PIO + PIO_SODR] = device->TMS_MASK;
|
|
else
|
|
pio_base[device->TMS_PIO + PIO_CODR] = device->TMS_MASK;
|
|
|
|
if (tdi)
|
|
pio_base[device->TDI_PIO + PIO_SODR] = device->TDI_MASK;
|
|
else
|
|
pio_base[device->TDI_PIO + PIO_CODR] = device->TDI_MASK;
|
|
}
|
|
|
|
/* (1) assert or (0) deassert reset lines */
|
|
static void at91rm9200_reset(int trst, int srst)
|
|
{
|
|
if (trst == 0)
|
|
pio_base[device->TRST_PIO + PIO_SODR] = device->TRST_MASK;
|
|
else if (trst == 1)
|
|
pio_base[device->TRST_PIO + PIO_CODR] = device->TRST_MASK;
|
|
|
|
if (srst == 0)
|
|
pio_base[device->SRST_PIO + PIO_SODR] = device->SRST_MASK;
|
|
else if (srst == 1)
|
|
pio_base[device->SRST_PIO + PIO_CODR] = device->SRST_MASK;
|
|
}
|
|
|
|
COMMAND_HANDLER(at91rm9200_handle_device_command)
|
|
{
|
|
if (CMD_ARGC == 0)
|
|
return ERROR_COMMAND_SYNTAX_ERROR;
|
|
|
|
/* only if the device name wasn't overwritten by cmdline */
|
|
if (at91rm9200_device == 0) {
|
|
at91rm9200_device = malloc(strlen(CMD_ARGV[0]) + sizeof(char));
|
|
strcpy(at91rm9200_device, CMD_ARGV[0]);
|
|
}
|
|
|
|
return ERROR_OK;
|
|
}
|
|
|
|
static const struct command_registration at91rm9200_command_handlers[] = {
|
|
{
|
|
.name = "at91rm9200_device",
|
|
.handler = &at91rm9200_handle_device_command,
|
|
.mode = COMMAND_CONFIG,
|
|
.help = "query armjtagew info",
|
|
},
|
|
COMMAND_REGISTRATION_DONE
|
|
};
|
|
|
|
struct jtag_interface at91rm9200_interface = {
|
|
.name = "at91rm9200",
|
|
.execute_queue = bitbang_execute_queue,
|
|
.commands = at91rm9200_command_handlers,
|
|
.init = at91rm9200_init,
|
|
.quit = at91rm9200_quit,
|
|
};
|
|
|
|
static int at91rm9200_init(void)
|
|
{
|
|
const struct device_t *cur_device;
|
|
|
|
cur_device = devices;
|
|
|
|
if (at91rm9200_device == NULL || at91rm9200_device[0] == 0) {
|
|
at91rm9200_device = "rea_ecr";
|
|
LOG_WARNING("No at91rm9200 device specified, using default 'rea_ecr'");
|
|
}
|
|
|
|
while (cur_device->name) {
|
|
if (strcmp(cur_device->name, at91rm9200_device) == 0) {
|
|
device = cur_device;
|
|
break;
|
|
}
|
|
cur_device++;
|
|
}
|
|
|
|
if (!device) {
|
|
LOG_ERROR("No matching device found for %s", at91rm9200_device);
|
|
return ERROR_JTAG_INIT_FAILED;
|
|
}
|
|
|
|
bitbang_interface = &at91rm9200_bitbang;
|
|
|
|
dev_mem_fd = open("/dev/mem", O_RDWR | O_SYNC);
|
|
if (dev_mem_fd < 0) {
|
|
perror("open");
|
|
return ERROR_JTAG_INIT_FAILED;
|
|
}
|
|
|
|
sys_controller = mmap(NULL, 4096, PROT_READ | PROT_WRITE,
|
|
MAP_SHARED, dev_mem_fd, AT91C_BASE_SYS);
|
|
if (sys_controller == MAP_FAILED) {
|
|
perror("mmap");
|
|
close(dev_mem_fd);
|
|
return ERROR_JTAG_INIT_FAILED;
|
|
}
|
|
pio_base = (uint32_t *)sys_controller + 0x100;
|
|
|
|
/*
|
|
* Configure TDO as an input, and TDI, TCK, TMS, TRST, SRST
|
|
* as outputs. Drive TDI and TCK low, and TMS/TRST/SRST high.
|
|
*/
|
|
pio_base[device->TDI_PIO + PIO_CODR] = device->TDI_MASK;
|
|
pio_base[device->TDI_PIO + PIO_OER] = device->TDI_MASK;
|
|
pio_base[device->TDI_PIO + PIO_PER] = device->TDI_MASK;
|
|
pio_base[device->TCK_PIO + PIO_CODR] = device->TCK_MASK;
|
|
pio_base[device->TCK_PIO + PIO_OER] = device->TCK_MASK;
|
|
pio_base[device->TCK_PIO + PIO_PER] = device->TCK_MASK;
|
|
pio_base[device->TMS_PIO + PIO_SODR] = device->TMS_MASK;
|
|
pio_base[device->TMS_PIO + PIO_OER] = device->TMS_MASK;
|
|
pio_base[device->TMS_PIO + PIO_PER] = device->TMS_MASK;
|
|
pio_base[device->TRST_PIO + PIO_SODR] = device->TRST_MASK;
|
|
pio_base[device->TRST_PIO + PIO_OER] = device->TRST_MASK;
|
|
pio_base[device->TRST_PIO + PIO_PER] = device->TRST_MASK;
|
|
pio_base[device->SRST_PIO + PIO_SODR] = device->SRST_MASK;
|
|
pio_base[device->SRST_PIO + PIO_OER] = device->SRST_MASK;
|
|
pio_base[device->SRST_PIO + PIO_PER] = device->SRST_MASK;
|
|
pio_base[device->TDO_PIO + PIO_ODR] = device->TDO_MASK;
|
|
pio_base[device->TDO_PIO + PIO_PPUER] = device->TDO_MASK;
|
|
pio_base[device->TDO_PIO + PIO_PER] = device->TDO_MASK;
|
|
|
|
return ERROR_OK;
|
|
}
|
|
|
|
static int at91rm9200_quit(void)
|
|
{
|
|
|
|
return ERROR_OK;
|
|
}
|