greg
/
dmrconfig
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Trace USB protocol.

This commit is contained in:
Serge Vakulenko 2018-08-27 17:50:32 -07:00
parent cce49310ba
commit 7bd1d26dba
2 changed files with 81 additions and 19 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

81
dfu.c
View File

@ -30,6 +30,7 @@
#include <string.h> #include <string.h>
#include <unistd.h> #include <unistd.h>
#include <libusb-1.0/libusb.h> #include <libusb-1.0/libusb.h>
#include "util.h"
// //
// USB request types. // USB request types.
@ -110,6 +111,9 @@ static status_t status;
static int detach(int timeout) static int detach(int timeout)
{ {
if (serial_verbose) {
printf("--- Send DETACH\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_DETACH, timeout, 0, NULL, 0, 0); REQUEST_DETACH, timeout, 0, NULL, 0, 0);
return error; return error;
@ -117,29 +121,52 @@ static int detach(int timeout)
static int get_status() static int get_status()
{ {
if (serial_verbose) {
printf("--- Send GETSTATUS [6]\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST,
REQUEST_GETSTATUS, 0, 0, (unsigned char*)&status, 6, 0); REQUEST_GETSTATUS, 0, 0, (unsigned char*)&status, 6, 0);
if (serial_verbose && error == USB_OK) {
printf("--- Recv ");
print_hex((unsigned char*)&status, 6);
printf("\n");
}
return error; return error;
} }
static int clear_status() static int clear_status()
{ {
if (serial_verbose) {
printf("--- Send CLRSTATUS\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_CLRSTATUS, 0, 0, NULL, 0, 0); REQUEST_CLRSTATUS, 0, 0, NULL, 0, 0);
return error; return error;
} }
static int get_state(int *state) static int get_state(int *pstate)
{ {
unsigned char state_buf; unsigned char state;
if (serial_verbose) {
printf("--- Send GETSTATE [1]\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST,
REQUEST_GETSTATE, 0, 0, &state_buf, 1, 0); REQUEST_GETSTATE, 0, 0, &state, 1, 0);
*state = state_buf; *pstate = state;
if (serial_verbose && error == USB_OK) {
printf("--- Recv ");
print_hex(&state, 1);
printf("\n");
}
return error; return error;
} }
static int dfu_abort() static int dfu_abort()
{ {
if (serial_verbose) {
printf("--- Send ABORT\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_ABORT, 0, 0, NULL, 0, 0); REQUEST_ABORT, 0, 0, NULL, 0, 0);
return error; return error;
@ -191,6 +218,12 @@ static void wait_dfu_idle()
static void md380_command(uint8_t a, uint8_t b) static void md380_command(uint8_t a, uint8_t b)
{ {
unsigned char cmd[2] = { a, b }; unsigned char cmd[2] = { a, b };
if (serial_verbose) {
printf("--- Send DNLOAD [2] ");
print_hex(cmd, 2);
printf("\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_DNLOAD, 0, 0, cmd, 2, 0); REQUEST_DNLOAD, 0, 0, cmd, 2, 0);
if (error < 0) { if (error < 0) {
@ -211,6 +244,12 @@ static void set_address(uint32_t address)
(uint8_t)(address >> 16), (uint8_t)(address >> 16),
(uint8_t)(address >> 24), (uint8_t)(address >> 24),
}; };
if (serial_verbose) {
printf("--- Send DNLOAD [5] ");
print_hex(cmd, 5);
printf("\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_DNLOAD, 0, 0, cmd, 5, 0); REQUEST_DNLOAD, 0, 0, cmd, 5, 0);
if (error < 0) { if (error < 0) {
@ -230,6 +269,12 @@ static void erase_block(uint32_t address)
(uint8_t)(address >> 16), (uint8_t)(address >> 16),
(uint8_t)(address >> 24), (uint8_t)(address >> 24),
}; };
if (serial_verbose) {
printf("--- Send DNLOAD [5] ");
print_hex(cmd, 5);
printf("\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_DNLOAD, 0, 0, cmd, 5, 0); REQUEST_DNLOAD, 0, 0, cmd, 5, 0);
if (error < 0) { if (error < 0) {
@ -247,6 +292,9 @@ static const char *identify()
md380_command(0xa2, 0x01); md380_command(0xa2, 0x01);
if (serial_verbose) {
printf("--- Send UPLOAD [64]\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST,
REQUEST_UPLOAD, 0, 0, data, 64, 0); REQUEST_UPLOAD, 0, 0, data, 64, 0);
if (error < 0) { if (error < 0) {
@ -254,15 +302,16 @@ static const char *identify()
__func__, error, libusb_strerror(error)); __func__, error, libusb_strerror(error));
exit(-1); exit(-1);
} }
//printf("%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x-%02x\n", if (serial_verbose && error == USB_OK) {
//data[0], data[1], data[2], data[3], data[4], data[5], data[6], data[7], printf("--- Recv ");
//data[8], data[9], data[10], data[11], data[12], data[13], data[14], data[15]); print_hex(data, 64);
printf("\n");
}
get_status(); get_status();
return (const char*) data; return (const char*) data;
} }
const char *dfu_init(uint16_t vid, uint16_t pid) const char *dfu_init(unsigned vid, unsigned pid)
{ {
int error = libusb_init(&ctx); int error = libusb_init(&ctx);
if (error < 0) { if (error < 0) {
@ -353,6 +402,9 @@ void dfu_read_block(int bno, uint8_t *data, int nbytes)
if (bno >= 256) if (bno >= 256)
bno += 832; bno += 832;
if (serial_verbose) {
printf("--- Send UPLOAD [%d]\n", nbytes);
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_HOST,
REQUEST_UPLOAD, bno+2, 0, data, nbytes, 0); REQUEST_UPLOAD, bno+2, 0, data, nbytes, 0);
if (error < 0) { if (error < 0) {
@ -360,7 +412,11 @@ void dfu_read_block(int bno, uint8_t *data, int nbytes)
__func__, bno, nbytes, error, libusb_strerror(error)); __func__, bno, nbytes, error, libusb_strerror(error));
exit(-1); exit(-1);
} }
if (serial_verbose && error == USB_OK) {
printf("--- Recv ");
print_hex(data, nbytes);
printf("\n");
}
get_status(); get_status();
} }
@ -369,6 +425,11 @@ void dfu_write_block(int bno, uint8_t *data, int nbytes)
if (bno >= 256) if (bno >= 256)
bno += 832; bno += 832;
if (serial_verbose) {
printf("--- Send DNLOAD [%d] ", nbytes);
print_hex(data, nbytes);
printf("\n");
}
int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE, int error = libusb_control_transfer(dev, REQUEST_TYPE_TO_DEVICE,
REQUEST_DNLOAD, bno+2, 0, data, nbytes, 0); REQUEST_DNLOAD, bno+2, 0, data, nbytes, 0);
if (error < 0) { if (error < 0) {

19
main.c
View File

@ -42,20 +42,21 @@ void usage()
fprintf(stderr, _("DMR Config, Version %s, %s\n"), version, copyright); fprintf(stderr, _("DMR Config, Version %s, %s\n"), version, copyright);
fprintf(stderr, _("Usage:\n")); fprintf(stderr, _("Usage:\n"));
fprintf(stderr, _(" dmrconfig [-v] -r\n")); fprintf(stderr, _(" dmrconfig [-v] -r\n"));
fprintf(stderr, _(" Save device binary image to file 'device.img',\n")); fprintf(stderr, _(" Read image from the radio and save it to a binary file 'device.img'.\n"));
fprintf(stderr, _(" and text configuration to 'device.conf'.\n")); fprintf(stderr, _(" Save configuration to a text file 'device.conf'.\n"));
fprintf(stderr, _(" dmrconfig -w [-v] file.img\n")); fprintf(stderr, _(" dmrconfig -w [-v] file.img\n"));
fprintf(stderr, _(" Write image to device.\n")); fprintf(stderr, _(" Write image to the radio.\n"));
fprintf(stderr, _(" dmrconfig -c [-v] file.conf\n")); fprintf(stderr, _(" dmrconfig -c [-v] file.conf\n"));
fprintf(stderr, _(" Configure device from text file.\n")); fprintf(stderr, _(" Apply configuration script to the radio.\n"));
fprintf(stderr, _(" dmrconfig -c [-v] file.img file.conf\n")); fprintf(stderr, _(" dmrconfig -c [-v] file.img file.conf\n"));
fprintf(stderr, _(" Apply text configuration to the image.\n")); fprintf(stderr, _(" Apply text configuration to the image file.\n"));
fprintf(stderr, _(" Store modified copy to a file 'device.img'.\n"));
fprintf(stderr, _(" dmrconfig file.img\n")); fprintf(stderr, _(" dmrconfig file.img\n"));
fprintf(stderr, _(" Display configuration from image file.\n")); fprintf(stderr, _(" Display configuration from the image file.\n"));
fprintf(stderr, _("Options:\n")); fprintf(stderr, _("Options:\n"));
fprintf(stderr, _(" -w Write image to device.\n")); fprintf(stderr, _(" -w Write image to the radio.\n"));
fprintf(stderr, _(" -c Configure device from text file.\n")); fprintf(stderr, _(" -c Configure the radio from a text file.\n"));
fprintf(stderr, _(" -v Trace serial protocol.\n")); fprintf(stderr, _(" -v Trace USB protocol.\n"));
exit(-1); exit(-1);
} }