367 lines
8.6 KiB
C
367 lines
8.6 KiB
C
/* MSPDebug - debugging tool for MSP430 MCUs
|
|
* Copyright (C) 2009-2012 Daniel Beer
|
|
* Copyright (C) 2012 Peter Bägel
|
|
*
|
|
* ppdev/ppi abstraction inspired by uisp src/DARPA.C
|
|
* originally written by Sergey Larin;
|
|
* corrected by Denis Chertykov, Uros Platise and Marek Michalkiewicz.
|
|
*
|
|
* 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 St, Fifth Floor, Boston, MA 02110-1301 USA
|
|
*/
|
|
|
|
#include <stdint.h>
|
|
#include "jtaglib.h"
|
|
#include "output.h"
|
|
|
|
#if defined(__linux__) || \
|
|
( defined(__FreeBSD__) || defined(__DragonFly__) )
|
|
/*===== includes =============================================================*/
|
|
|
|
#include <fcntl.h>
|
|
#include <unistd.h>
|
|
|
|
#if defined(__linux__)
|
|
|
|
#include <linux/ppdev.h>
|
|
|
|
#define par_claim(fd) ioctl(fd, PPCLAIM, NULL)
|
|
#define par_write_data(fd, ptr) ioctl(fd, PPWDATA, ptr)
|
|
#define par_write_control(fd, ptr) ioctl(fd, PPWCONTROL, ptr)
|
|
#define par_release(fd) ioctl(fd, PPRELEASE, NULL)
|
|
#define par_read_status(fd, ptr) ioctl(fd, PPRSTATUS, ptr)
|
|
|
|
#elif defined(__FreeBSD__) || defined(__DragonFly__)
|
|
|
|
#if defined(__FreeBSD__)
|
|
#include <dev/ppbus/ppi.h>
|
|
#include <dev/ppbus/ppbconf.h>
|
|
#else /* __DragonFly__ */
|
|
#include <dev/misc/ppi/ppi.h>
|
|
#include <bus/ppbus/ppbconf.h>
|
|
#endif
|
|
|
|
#define par_claim(fd) (0)
|
|
#define par_write_data(fd, ptr) ioctl(fd, PPISDATA, ptr)
|
|
#define par_write_control(fd, ptr) ioctl(fd, PPISCTRL, ptr)
|
|
#define par_release(fd) (0)
|
|
#define par_read_status(fd, ptr) ioctl(fd, PPIGSTATUS, ptr)
|
|
|
|
#endif /* __linux__ || (__FreeBSD__ || __DragonFly__) */
|
|
|
|
#include <sys/ioctl.h>
|
|
|
|
#include "util.h"
|
|
|
|
/*===== private symbols ======================================================*/
|
|
|
|
/*--- port data (out) ---*/
|
|
#define DATA0 ((unsigned char)0x01)
|
|
#define DATA1 ((unsigned char)0x02)
|
|
#define DATA2 ((unsigned char)0x04)
|
|
#define DATA3 ((unsigned char)0x08)
|
|
#define DATA4 ((unsigned char)0x10)
|
|
#define DATA5 ((unsigned char)0x20)
|
|
#define DATA6 ((unsigned char)0x40)
|
|
#define DATA7 ((unsigned char)0x80)
|
|
|
|
/*--- port status (in) ---*/
|
|
#define ERR ((unsigned char)0x08)
|
|
#define SEL ((unsigned char)0x10)
|
|
#define PE ((unsigned char)0x20)
|
|
#define ACK ((unsigned char)0x40)
|
|
#define BUSY ((unsigned char)0x80)
|
|
|
|
/*--- port control (out) ---*/
|
|
#ifndef STROBE
|
|
#define STROBE ((unsigned char)0x01) /* inverted by PC-hardware */
|
|
#endif
|
|
#ifndef AUTOFEED
|
|
#define AUTOFEED ((unsigned char)0x02)
|
|
#endif
|
|
#ifndef INIT
|
|
#define INIT ((unsigned char)0x04)
|
|
#endif
|
|
#ifndef SELECTIN
|
|
#define SELECTIN ((unsigned char)0x08)
|
|
#endif
|
|
#define IRQEN ((unsigned char)0x10)
|
|
|
|
/*--- JTAG signal mapping ---*/
|
|
#define TEST INIT
|
|
#define TDO PE
|
|
#define TDI DATA0
|
|
#define TMS DATA1
|
|
#define TCK DATA2
|
|
#define XOUT DATA3
|
|
#define POWER (DATA4 | DATA7)
|
|
#define RESET STROBE
|
|
#define ENABLE (SELECTIN | AUTOFEED)
|
|
#define LED_GREEN DATA5
|
|
#define LED_RED DATA6
|
|
|
|
#define TCLK TDI
|
|
|
|
/*===== public functions =====================================================*/
|
|
|
|
static void do_ppwdata(struct jtdev *p)
|
|
{
|
|
if (par_write_data(p->port, &p->data_register) < 0) {
|
|
pr_error("jtdev: par_write_data");
|
|
p->failed = 1;
|
|
}
|
|
}
|
|
|
|
static void do_ppwcontrol(struct jtdev *p)
|
|
{
|
|
if (par_write_control(p->port, &p->control_register) < 0) {
|
|
pr_error("jtdev: par_write_control");
|
|
p->failed = 1;
|
|
}
|
|
}
|
|
|
|
static int jtpif_open(struct jtdev *p, const char *device)
|
|
{
|
|
p->port = open(device, O_RDWR);
|
|
if (p->port < 0) {
|
|
printc_err("jtdev: can't open %s: %s\n",
|
|
device, last_error());
|
|
return -1;
|
|
}
|
|
|
|
if (par_claim(p->port) < 0) {
|
|
printc_err("jtdev: par_claim: %s: %s\n",
|
|
device, last_error());
|
|
close(p->port);
|
|
return -1;
|
|
}
|
|
|
|
p->data_register = 0;
|
|
p->control_register = 0;
|
|
p->failed = 0;
|
|
|
|
do_ppwdata(p);
|
|
do_ppwcontrol(p);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static void jtpif_close(struct jtdev *p)
|
|
{
|
|
if (par_release(p->port) < 0)
|
|
pr_error("warning: jtdev: failed to release port");
|
|
|
|
close(p->port);
|
|
}
|
|
|
|
static void jtpif_power_on(struct jtdev *p)
|
|
{
|
|
/* power supply on */
|
|
p->data_register |= POWER;
|
|
do_ppwdata(p);
|
|
}
|
|
|
|
static void jtpif_power_off(struct jtdev *p)
|
|
{
|
|
/* power supply off */
|
|
p->data_register &= ~POWER;
|
|
do_ppwdata(p);
|
|
|
|
/* a high, inactive reset also powers the target */
|
|
/* reset pin is inverted by PC hardware */
|
|
p->control_register |= RESET;
|
|
do_ppwcontrol(p);
|
|
}
|
|
|
|
static void jtpif_connect(struct jtdev *p)
|
|
{
|
|
p->control_register |= (TEST | ENABLE);
|
|
do_ppwcontrol(p);
|
|
}
|
|
|
|
static void jtpif_release(struct jtdev *p)
|
|
{
|
|
p->control_register &= ~(TEST | ENABLE);
|
|
do_ppwcontrol(p);
|
|
}
|
|
|
|
static void jtpif_tck(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->data_register |= TCK;
|
|
else
|
|
p->data_register &= ~TCK;
|
|
|
|
do_ppwdata(p);
|
|
}
|
|
|
|
static void jtpif_tms(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->data_register |= TMS;
|
|
else
|
|
p->data_register &= ~TMS;
|
|
|
|
do_ppwdata(p);
|
|
}
|
|
|
|
static void jtpif_tdi(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->data_register |= TDI;
|
|
else
|
|
p->data_register &= ~TDI;
|
|
|
|
do_ppwdata(p);
|
|
}
|
|
|
|
static void jtpif_rst(struct jtdev *p, int out)
|
|
{
|
|
/* reset pin is inverted by PC hardware */
|
|
if (out)
|
|
p->control_register &= ~RESET;
|
|
else
|
|
p->control_register |= RESET;
|
|
|
|
do_ppwcontrol(p);
|
|
}
|
|
|
|
static void jtpif_tst(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->control_register |= TEST;
|
|
else
|
|
p->control_register &= ~TEST;
|
|
|
|
do_ppwcontrol(p);
|
|
}
|
|
|
|
static int jtpif_tdo_get(struct jtdev *p)
|
|
{
|
|
uint8_t input;
|
|
|
|
if (par_read_status(p->port, &input) < 0) {
|
|
pr_error("jtdev: par_read_status:");
|
|
p->failed = 1;
|
|
return 0;
|
|
}
|
|
|
|
return (input & TDO) ? 1 : 0;
|
|
}
|
|
|
|
static void jtpif_tclk(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->data_register |= TCLK;
|
|
else
|
|
p->data_register &= ~TCLK;
|
|
|
|
do_ppwdata(p);
|
|
}
|
|
|
|
static int jtpif_tclk_get(struct jtdev *p)
|
|
{
|
|
return (p->data_register & TCLK) ? 1 : 0;
|
|
}
|
|
|
|
static void jtpif_tclk_strobe(struct jtdev *p, unsigned int count)
|
|
{
|
|
int i;
|
|
|
|
for (i = 0; i < count; i++) {
|
|
jtpif_tclk(p, 1);
|
|
jtpif_tclk(p, 0);
|
|
|
|
if (p->failed)
|
|
return;
|
|
}
|
|
}
|
|
|
|
static void jtpif_led_green(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->data_register |= LED_GREEN;
|
|
else
|
|
p->data_register &= ~LED_GREEN;
|
|
|
|
do_ppwdata(p);
|
|
}
|
|
|
|
static void jtpif_led_red(struct jtdev *p, int out)
|
|
{
|
|
if (out)
|
|
p->data_register |= LED_RED;
|
|
else
|
|
p->data_register &= ~LED_RED;
|
|
|
|
do_ppwdata(p);
|
|
}
|
|
#else /* __linux__ */
|
|
static int jtpif_open(struct jtdev *p, const char *device)
|
|
{
|
|
printc_err("jtdev: driver is not supported on this platform\n");
|
|
p->failed = 1;
|
|
return -1;
|
|
}
|
|
|
|
static void jtpif_close(struct jtdev *p) { }
|
|
|
|
static void jtpif_power_on(struct jtdev *p) { }
|
|
static void jtpif_power_off(struct jtdev *p) { }
|
|
static void jtpif_connect(struct jtdev *p) { }
|
|
static void jtpif_release(struct jtdev *p) { }
|
|
|
|
static void jtpif_tck(struct jtdev *p, int out) { }
|
|
static void jtpif_tms(struct jtdev *p, int out) { }
|
|
static void jtpif_tdi(struct jtdev *p, int out) { }
|
|
static void jtpif_rst(struct jtdev *p, int out) { }
|
|
static void jtpif_tst(struct jtdev *p, int out) { }
|
|
static int jtpif_tdo_get(struct jtdev *p) { return 0; }
|
|
|
|
static void jtpif_tclk(struct jtdev *p, int out) { }
|
|
static int jtpif_tclk_get(struct jtdev *p) { return 0; }
|
|
static void jtpif_tclk_strobe(struct jtdev *p, unsigned int count) { }
|
|
|
|
static void jtpif_led_green(struct jtdev *p, int out) { }
|
|
static void jtpif_led_red(struct jtdev *p, int out) { }
|
|
#endif
|
|
|
|
const struct jtdev_func jtdev_func_pif = {
|
|
.jtdev_open = jtpif_open,
|
|
.jtdev_close = jtpif_close,
|
|
.jtdev_power_on = jtpif_power_on,
|
|
.jtdev_power_off = jtpif_power_off,
|
|
.jtdev_connect = jtpif_connect,
|
|
.jtdev_release = jtpif_release,
|
|
.jtdev_tck = jtpif_tck,
|
|
.jtdev_tms = jtpif_tms,
|
|
.jtdev_tdi = jtpif_tdi,
|
|
.jtdev_rst = jtpif_rst,
|
|
.jtdev_tst = jtpif_tst,
|
|
.jtdev_tdo_get = jtpif_tdo_get,
|
|
.jtdev_tclk = jtpif_tclk,
|
|
.jtdev_tclk_get = jtpif_tclk_get,
|
|
.jtdev_tclk_strobe = jtpif_tclk_strobe,
|
|
.jtdev_led_green = jtpif_led_green,
|
|
.jtdev_led_red = jtpif_led_red,
|
|
|
|
.jtdev_ir_shift = jtag_default_ir_shift,
|
|
.jtdev_dr_shift_8 = jtag_default_dr_shift_8,
|
|
.jtdev_dr_shift_16 = jtag_default_dr_shift_16,
|
|
.jtdev_dr_shift_20 = jtag_default_dr_shift_20,
|
|
.jtdev_tms_sequence= jtag_default_tms_sequence,
|
|
.jtdev_init_dap = jtag_default_init_dap
|
|
};
|
|
|