X-Git-Url: https://review.openocd.org/gitweb?a=blobdiff_plain;f=src%2Fjtag%2Fgw16012.c;h=2d7b453b4635ef066372f41ffa75c6d3bb872706;hb=31fc1586a064b8631956095cb029290e1dc6625f;hp=6991a66c9e4f8354ebb502f7daef40eb68f58965;hpb=f876d5e9c769a288faa7fd14b7bf373363542aab;p=openocd.git diff --git a/src/jtag/gw16012.c b/src/jtag/gw16012.c index 6991a66c9e..2d7b453b46 100644 --- a/src/jtag/gw16012.c +++ b/src/jtag/gw16012.c @@ -78,34 +78,6 @@ static uint8_t gw16012_control_value = 0x0; static int device_handle; #endif -static int gw16012_execute_queue(void); -static int gw16012_register_commands(struct command_context_s *cmd_ctx); -static int gw16012_speed(int speed); -static int gw16012_init(void); -static int gw16012_quit(void); - -static int gw16012_handle_parport_port_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc); - -jtag_interface_t gw16012_interface = -{ - .name = "gw16012", - - .execute_queue = gw16012_execute_queue, - - .speed = gw16012_speed, - .register_commands = gw16012_register_commands, - .init = gw16012_init, - .quit = gw16012_quit, -}; - -static int gw16012_register_commands(struct command_context_s *cmd_ctx) -{ - register_command(cmd_ctx, NULL, "parport_port", gw16012_handle_parport_port_command, - COMMAND_CONFIG, NULL); - - return ERROR_OK; -} - static void gw16012_data(uint8_t value) { value = (value & 0x7f) | gw16012_msb; @@ -196,7 +168,7 @@ static void gw16012_end_state(tap_state_t state) static void gw16012_state_move(void) { - int i=0, tms=0; + int i = 0, tms = 0; uint8_t tms_scan = tap_get_tms_path(tap_get_state(), tap_get_end_state()); int tms_count = tap_get_tms_path_len(tap_get_state(), tap_get_end_state()); @@ -211,7 +183,7 @@ static void gw16012_state_move(void) tap_set_state(tap_get_end_state()); } -static void gw16012_path_move(pathmove_command_t *cmd) +static void gw16012_path_move(struct pathmove_command *cmd) { int num_states = cmd->num_states; int state_count; @@ -340,7 +312,7 @@ static void gw16012_scan(bool ir_scan, enum scan_type type, uint8_t *buffer, int static int gw16012_execute_queue(void) { - jtag_command_t *cmd = jtag_command_queue; /* currently processed command */ + struct jtag_command *cmd = jtag_command_queue; /* currently processed command */ int scan_size; enum scan_type type; uint8_t *buffer; @@ -422,20 +394,20 @@ static int gw16012_get_giveio_access(void) OSVERSIONINFO version; version.dwOSVersionInfoSize = sizeof version; - if (!GetVersionEx( &version )) { + if (!GetVersionEx(&version)) { errno = EINVAL; return -1; } if (version.dwPlatformId != VER_PLATFORM_WIN32_NT) return 0; - h = CreateFile( "\\\\.\\giveio", GENERIC_READ, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL ); + h = CreateFile("\\\\.\\giveio", GENERIC_READ, 0, NULL, OPEN_EXISTING, FILE_ATTRIBUTE_NORMAL, NULL); if (h == INVALID_HANDLE_VALUE) { errno = ENODEV; return -1; } - CloseHandle( h ); + CloseHandle(h); return 0; } @@ -500,7 +472,7 @@ static int gw16012_init_device(void) LOG_DEBUG("opening %s...", buffer); device_handle = open(buffer, O_WRONLY); - if (device_handle<0) + if (device_handle < 0) { LOG_ERROR("cannot open device. check it exists and that user read and write rights are set"); return ERROR_JTAG_INIT_FAILED; @@ -524,7 +496,7 @@ static int gw16012_init_device(void) LOG_WARNING("No gw16012 port specified, using default '0x378' (LPT1)"); } - LOG_DEBUG("requesting privileges for parallel port 0x%lx...", (long unsigned)(gw16012_port) ); + LOG_DEBUG("requesting privileges for parallel port 0x%lx...", (long unsigned)(gw16012_port)); #if PARPORT_USE_GIVEIO == 1 if (gw16012_get_giveio_access() != 0) #else /* PARPORT_USE_GIVEIO */ @@ -569,16 +541,14 @@ static int gw16012_quit(void) return ERROR_OK; } -static int gw16012_handle_parport_port_command(struct command_context_s *cmd_ctx, char *cmd, char **args, int argc) +COMMAND_HANDLER(gw16012_handle_parport_port_command) { - if (argc == 1) + if (CMD_ARGC == 1) { /* only if the port wasn't overwritten by cmdline */ if (gw16012_port == 0) { - int retval = parse_u16(args[0], &gw16012_port); - if (ERROR_OK != retval) - return retval; + COMMAND_PARSE_NUMBER(u16, CMD_ARGV[0], gw16012_port); } else { @@ -587,7 +557,25 @@ static int gw16012_handle_parport_port_command(struct command_context_s *cmd_ctx } } - command_print(cmd_ctx, "parport port = %u", gw16012_port); + command_print(CMD_CTX, "parport port = %u", gw16012_port); + + return ERROR_OK; +} + +static int gw16012_register_commands(struct command_context *cmd_ctx) +{ + register_command(cmd_ctx, NULL, "parport_port", + gw16012_handle_parport_port_command, COMMAND_CONFIG, + NULL); return ERROR_OK; } + +struct jtag_interface gw16012_interface = { + .name = "gw16012", + .register_commands = &gw16012_register_commands, + .init = &gw16012_init, + .quit = &gw16012_quit, + .speed = &gw16012_speed, + .execute_queue = &gw16012_execute_queue, + };