X-Git-Url: https://review.openocd.org/gitweb?p=openocd.git;a=blobdiff_plain;f=src%2Fjtag%2Fdrivers%2Fparport.c;h=14fa9df9f7fdee1da797408bc6f697cdc0f45c0a;hp=7ff675bab3f40745071e945cacd5250d81003ec7;hb=64f1f7b1c179dcce4e008bef6bf9515c47ae4100;hpb=165fb9309d16ff91967f26ce8c01bfd176371506
diff --git a/src/jtag/drivers/parport.c b/src/jtag/drivers/parport.c
index 7ff675bab3..14fa9df9f7 100644
--- a/src/jtag/drivers/parport.c
+++ b/src/jtag/drivers/parport.c
@@ -16,10 +16,9 @@
* 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., *
- * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
+ * along with this program. If not, see . *
***************************************************************************/
+
#ifdef HAVE_CONFIG_H
#include "config.h"
#endif
@@ -31,8 +30,8 @@
#if defined(__FreeBSD__) || defined(__FreeBSD_kernel__)
#include
#include
-#define ioperm(startport,length,enable)\
- i386_set_ioperm((startport), (length), (enable))
+#define ioperm(startport, length, enable)\
+ i386_set_ioperm((startport), (length), (enable))
#endif /* __FreeBSD__ */
#if PARPORT_USE_PPDEV == 1
@@ -56,11 +55,10 @@
#include
#endif
-
/* parallel port cable description
*/
struct cable {
- char* name;
+ const char *name;
uint8_t TDO_MASK; /* status port bit containing current TDO value */
uint8_t TRST_MASK; /* data port bit for TRST */
uint8_t TMS_MASK; /* data port bit for TMS */
@@ -74,14 +72,12 @@ struct cable {
uint8_t LED_MASK; /* data port bit for LED */
};
-static struct cable cables[] =
-{
- /* name tdo trst tms tck tdi srst o_inv i_inv init exit led */
+static const struct cable cables[] = {
+ /* name tdo trst tms tck tdi srst o_inv i_inv init exit led */
{ "wiggler", 0x80, 0x10, 0x02, 0x04, 0x08, 0x01, 0x01, 0x80, 0x80, 0x80, 0x00 },
{ "wiggler2", 0x80, 0x10, 0x02, 0x04, 0x08, 0x01, 0x01, 0x80, 0x80, 0x00, 0x20 },
- { "wiggler_ntrst_inverted",
- 0x80, 0x10, 0x02, 0x04, 0x08, 0x01, 0x11, 0x80, 0x80, 0x80, 0x00 },
- { "old_amt_wiggler", 0x80, 0x01, 0x02, 0x04, 0x08, 0x10, 0x11, 0x80, 0x80, 0x80, 0x00 },
+ { "wiggler_ntrst_inverted", 0x80, 0x10, 0x02, 0x04, 0x08, 0x01, 0x11, 0x80, 0x80, 0x80, 0x00 },
+ { "old_amt_wiggler", 0x80, 0x01, 0x02, 0x04, 0x08, 0x10, 0x11, 0x80, 0x80, 0x80, 0x00 },
{ "arm-jtag", 0x80, 0x01, 0x02, 0x04, 0x08, 0x10, 0x01, 0x80, 0x80, 0x80, 0x00 },
{ "chameleon", 0x80, 0x00, 0x04, 0x01, 0x02, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00 },
{ "dlc5", 0x10, 0x00, 0x04, 0x02, 0x01, 0x00, 0x00, 0x00, 0x10, 0x10, 0x00 },
@@ -97,20 +93,21 @@ static struct cable cables[] =
SOFT TDI - Target SRST
*/
{ "altium", 0x10, 0x20, 0x04, 0x02, 0x01, 0x80, 0x00, 0x00, 0x10, 0x00, 0x08 },
+ { "aspo", 0x10, 0x01, 0x04, 0x08, 0x02, 0x10, 0x17, 0x00, 0x17, 0x17, 0x00 },
{ NULL, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }
};
/* configuration */
-static char* parport_cable = NULL;
+static char *parport_cable;
static uint16_t parport_port;
-static bool parport_exit = 0;
+static bool parport_exit;
static uint32_t parport_toggling_time_ns = 1000;
static int wait_states;
/* interface variables
*/
-static struct cable* cable;
-static uint8_t dataport_value = 0x0;
+static const struct cable *cable;
+static uint8_t dataport_value;
#if PARPORT_USE_PPDEV == 1
static int device_handle;
@@ -119,23 +116,23 @@ static unsigned long dataport;
static unsigned long statusport;
#endif
-static int parport_read(void)
+static bb_value_t parport_read(void)
{
int data = 0;
#if PARPORT_USE_PPDEV == 1
- ioctl(device_handle, PPRSTATUS, & data);
+ ioctl(device_handle, PPRSTATUS, &data);
#else
data = inb(statusport);
#endif
if ((data ^ cable->INPUT_INVERT) & cable->TDO_MASK)
- return 1;
+ return BB_HIGH;
else
- return 0;
+ return BB_LOW;
}
-static __inline__ void parport_write_data(void)
+static inline void parport_write_data(void)
{
uint8_t output;
output = dataport_value ^ cable->OUTPUT_INVERT;
@@ -151,7 +148,7 @@ static __inline__ void parport_write_data(void)
#endif
}
-static void parport_write(int tck, int tms, int tdi)
+static int parport_write(int tck, int tms, int tdi)
{
int i = wait_states + 1;
@@ -172,10 +169,12 @@ static void parport_write(int tck, int tms, int tdi)
while (i-- > 0)
parport_write_data();
+
+ return ERROR_OK;
}
/* (1) assert or (0) deassert reset lines */
-static void parport_reset(int trst, int srst)
+static int parport_reset(int trst, int srst)
{
LOG_DEBUG("trst: %i, srst: %i", trst, srst);
@@ -190,10 +189,12 @@ static void parport_reset(int trst, int srst)
dataport_value &= ~cable->SRST_MASK;
parport_write_data();
+
+ return ERROR_OK;
}
/* turn LED on parport adapter on (1) or off (0) */
-static void parport_led(int on)
+static int parport_led(int on)
{
if (on)
dataport_value |= cable->LED_MASK;
@@ -201,6 +202,8 @@ static void parport_led(int on)
dataport_value &= ~cable->LED_MASK;
parport_write_data();
+
+ return ERROR_OK;
}
static int parport_speed(int speed)
@@ -209,7 +212,7 @@ static int parport_speed(int speed)
return ERROR_OK;
}
-static int parport_khz(int khz, int* jtag_speed)
+static int parport_khz(int khz, int *jtag_speed)
{
if (khz == 0) {
LOG_DEBUG("RCLK not supported");
@@ -220,7 +223,7 @@ static int parport_khz(int khz, int* jtag_speed)
return ERROR_OK;
}
-static int parport_speed_div(int speed, int* khz)
+static int parport_speed_div(int speed, int *khz)
{
uint32_t denominator = (speed + 1) * parport_toggling_time_ns;
@@ -263,32 +266,27 @@ static struct bitbang_interface parport_bitbang = {
static int parport_init(void)
{
- struct cable *cur_cable;
+ const struct cable *cur_cable;
#if PARPORT_USE_PPDEV == 1
char buffer[256];
- int i = 0;
#endif
cur_cable = cables;
- if ((parport_cable == NULL) || (parport_cable[0] == 0))
- {
- parport_cable = "wiggler";
+ if (parport_cable == NULL) {
+ parport_cable = strdup("wiggler");
LOG_WARNING("No parport cable specified, using default 'wiggler'");
}
- while (cur_cable->name)
- {
- if (strcmp(cur_cable->name, parport_cable) == 0)
- {
+ while (cur_cable->name) {
+ if (strcmp(cur_cable->name, parport_cable) == 0) {
cable = cur_cable;
break;
}
cur_cable++;
}
- if (!cable)
- {
+ if (!cable) {
LOG_ERROR("No matching cable found for %s", parport_cable);
return ERROR_JTAG_INIT_FAILED;
}
@@ -296,8 +294,7 @@ static int parport_init(void)
dataport_value = cable->PORT_INIT;
#if PARPORT_USE_PPDEV == 1
- if (device_handle > 0)
- {
+ if (device_handle > 0) {
LOG_ERROR("device is already opened");
return ERROR_JTAG_INIT_FAILED;
}
@@ -314,8 +311,7 @@ static int parport_init(void)
device_handle = open(buffer, O_WRONLY);
#endif /* __FreeBSD__, __FreeBSD_kernel__ */
- if (device_handle < 0)
- {
+ if (device_handle < 0) {
int err = errno;
LOG_ERROR("cannot open device. check it exists and that user read and write rights are set. errno=%d", err);
return ERROR_JTAG_INIT_FAILED;
@@ -324,33 +320,30 @@ static int parport_init(void)
LOG_DEBUG("...open");
#if !defined(__FreeBSD__) && !defined(__FreeBSD_kernel__)
- i = ioctl(device_handle, PPCLAIM);
- if (i < 0)
- {
+ int i = ioctl(device_handle, PPCLAIM);
+
+ if (i < 0) {
LOG_ERROR("cannot claim device");
return ERROR_JTAG_INIT_FAILED;
}
i = PARPORT_MODE_COMPAT;
- i= ioctl(device_handle, PPSETMODE, & i);
- if (i < 0)
- {
+ i = ioctl(device_handle, PPSETMODE, &i);
+ if (i < 0) {
LOG_ERROR(" cannot set compatible mode to device");
return ERROR_JTAG_INIT_FAILED;
}
i = IEEE1284_MODE_COMPAT;
- i = ioctl(device_handle, PPNEGOT, & i);
- if (i < 0)
- {
+ i = ioctl(device_handle, PPNEGOT, &i);
+ if (i < 0) {
LOG_ERROR("cannot set compatible 1284 mode to device");
return ERROR_JTAG_INIT_FAILED;
}
#endif /* not __FreeBSD__, __FreeBSD_kernel__ */
#else /* not PARPORT_USE_PPDEV */
- if (parport_port == 0)
- {
+ if (parport_port == 0) {
parport_port = 0x378;
LOG_WARNING("No parport port specified, using default '0x378' (LPT1)");
}
@@ -360,11 +353,10 @@ static int parport_init(void)
LOG_DEBUG("requesting privileges for parallel port 0x%lx...", dataport);
#if PARPORT_USE_GIVEIO == 1
- if (parport_get_giveio_access() != 0)
+ if (parport_get_giveio_access() != 0) {
#else /* PARPORT_USE_GIVEIO */
- if (ioperm(dataport, 3, 1) != 0)
+ if (ioperm(dataport, 3, 1) != 0) {
#endif /* PARPORT_USE_GIVEIO */
- {
LOG_ERROR("missing privileges for direct i/o");
return ERROR_JTAG_INIT_FAILED;
}
@@ -379,29 +371,29 @@ static int parport_init(void)
#endif /* PARPORT_USE_PPDEV */
- parport_reset(0, 0);
- parport_write(0, 0, 0);
- parport_led(1);
+ if (parport_reset(0, 0) != ERROR_OK)
+ return ERROR_FAIL;
+ if (parport_write(0, 0, 0) != ERROR_OK)
+ return ERROR_FAIL;
+ if (parport_led(1) != ERROR_OK)
+ return ERROR_FAIL;
bitbang_interface = &parport_bitbang;
- wait_states = jtag_get_speed();
-
return ERROR_OK;
}
static int parport_quit(void)
{
- parport_led(0);
+ if (parport_led(0) != ERROR_OK)
+ return ERROR_FAIL;
- if (parport_exit)
- {
+ if (parport_exit) {
dataport_value = cable->PORT_EXIT;
parport_write_data();
}
- if (parport_cable)
- {
+ if (parport_cable) {
free(parport_cable);
parport_cable = NULL;
}
@@ -411,21 +403,17 @@ static int parport_quit(void)
COMMAND_HANDLER(parport_handle_parport_port_command)
{
- if (CMD_ARGC == 1)
- {
+ if (CMD_ARGC == 1) {
/* only if the port wasn't overwritten by cmdline */
if (parport_port == 0)
- {
COMMAND_PARSE_NUMBER(u16, CMD_ARGV[0], parport_port);
- }
- else
- {
+ else {
LOG_ERROR("The parport port was already configured!");
return ERROR_FAIL;
}
}
- command_print(CMD_CTX, "parport port = %u", parport_port);
+ command_print(CMD_CTX, "parport port = 0x%" PRIx16 "", parport_port);
return ERROR_OK;
}
@@ -436,22 +424,21 @@ COMMAND_HANDLER(parport_handle_parport_cable_command)
return ERROR_OK;
/* only if the cable name wasn't overwritten by cmdline */
- if (parport_cable == 0)
- {
+ if (parport_cable == 0) {
+ /* REVISIT first verify that it's listed in cables[] ... */
parport_cable = malloc(strlen(CMD_ARGV[0]) + sizeof(char));
strcpy(parport_cable, CMD_ARGV[0]);
}
+ /* REVISIT it's probably worth returning the current value ... */
+
return ERROR_OK;
}
COMMAND_HANDLER(parport_handle_write_on_exit_command)
{
if (CMD_ARGC != 1)
- {
- command_print(CMD_CTX, "usage: parport_write_on_exit ");
- return ERROR_OK;
- }
+ return ERROR_COMMAND_SYNTAX_ERROR;
COMMAND_PARSE_ON_OFF(CMD_ARGV[0], parport_exit);
@@ -473,7 +460,14 @@ COMMAND_HANDLER(parport_handle_parport_toggling_time_command)
}
parport_toggling_time_ns = ns;
- wait_states = jtag_get_speed();
+ retval = jtag_get_speed(&wait_states);
+ if (retval != ERROR_OK) {
+ /* if jtag_get_speed fails then the clock_mode
+ * has not been configured, this happens if parport_toggling_time is
+ * called before the adapter speed is set */
+ LOG_INFO("no parport speed set - defaulting to zero wait states");
+ wait_states = 0;
+ }
}
command_print(CMD_CTX, "parport toggling time = %" PRIu32 " ns",
@@ -485,49 +479,50 @@ COMMAND_HANDLER(parport_handle_parport_toggling_time_command)
static const struct command_registration parport_command_handlers[] = {
{
.name = "parport_port",
- .handler = &parport_handle_parport_port_command,
+ .handler = parport_handle_parport_port_command,
.mode = COMMAND_CONFIG,
- .help = "either the address of the I/O port "
- "or the number of the '/dev/parport' device",
- .usage = "[]",
+ .help = "Display the address of the I/O port (e.g. 0x378) "
+ "or the number of the '/dev/parport' device used. "
+ "If a parameter is provided, first change that port.",
+ .usage = "[port_number]",
},
{
.name = "parport_cable",
- .handler = &parport_handle_parport_cable_command,
+ .handler = parport_handle_parport_cable_command,
.mode = COMMAND_CONFIG,
- .help = "the layout of the parallel port cable "
- "used to connect to the target",
- .usage = "[]",
+ .help = "Set the layout of the parallel port cable "
+ "used to connect to the target.",
+ /* REVISIT there's no way to list layouts we know ... */
+ .usage = "[layout]",
},
{
.name = "parport_write_on_exit",
- .handler = &parport_handle_write_on_exit_command,
+ .handler = parport_handle_write_on_exit_command,
.mode = COMMAND_CONFIG,
- .help = "configure the parallel driver to write "
- "a known value to the parallel interface",
- .usage = "[]",
+ .help = "Configure the parallel driver to write "
+ "a known value to the parallel interface on exit.",
+ .usage = "('on'|'off')",
},
{
.name = "parport_toggling_time",
- .handler = &parport_handle_parport_toggling_time_command,
+ .handler = parport_handle_parport_toggling_time_command,
.mode = COMMAND_CONFIG,
- .help = "time it takes for the hardware to toggle TCK",
- .usage = "[]",
+ .help = "Displays or assigns how many nanoseconds it "
+ "takes for the hardware to toggle TCK.",
+ .usage = "[nanoseconds]",
},
COMMAND_REGISTRATION_DONE
};
struct jtag_interface parport_interface = {
- .name = "parport",
-
- .commands = parport_command_handlers,
-
- .init = &parport_init,
- .quit = &parport_quit,
-
- .khz = &parport_khz,
- .speed_div = &parport_speed_div,
- .speed = &parport_speed,
-
- .execute_queue = &bitbang_execute_queue,
- };
+ .name = "parport",
+ .supported = DEBUG_CAP_TMS_SEQ,
+ .commands = parport_command_handlers,
+
+ .init = parport_init,
+ .quit = parport_quit,
+ .khz = parport_khz,
+ .speed_div = parport_speed_div,
+ .speed = parport_speed,
+ .execute_queue = bitbang_execute_queue,
+};