From 05f0f33c1c24d36a92109fb3171da6564ca647df Mon Sep 17 00:00:00 2001 From: "Salvador E. Tropea" Date: Wed, 3 May 2017 10:25:09 -0300 Subject: Added code to restore the original timer latency. In this way the user can avoid 500 Hz interrupts. --- iceprog/iceprog.c | 16 +++++++++++++++- 1 file changed, 15 insertions(+), 1 deletion(-) diff --git a/iceprog/iceprog.c b/iceprog/iceprog.c index 0e0b587..5bb7ed1 100644 --- a/iceprog/iceprog.c +++ b/iceprog/iceprog.c @@ -38,6 +38,8 @@ struct ftdi_context ftdic; bool ftdic_open = false; bool verbose = false; +bool ftdic_latency_set = false; +unsigned char ftdi_latency; void check_rx() { @@ -53,8 +55,11 @@ void error() { check_rx(); fprintf(stderr, "ABORT.\n"); - if (ftdic_open) + if (ftdic_open) { + if (ftdic_latency_set) + ftdi_set_latency_timer(&ftdic, ftdi_latency); ftdi_usb_close(&ftdic); + } ftdi_deinit(&ftdic); exit(1); } @@ -454,11 +459,19 @@ int main(int argc, char **argv) error(); } + if (ftdi_get_latency_timer(&ftdic, &ftdi_latency) < 0) { + fprintf(stderr, "Failed to get latency timer (%s).\n", ftdi_get_error_string(&ftdic)); + error(); + } + + /* 2 is the ideal value, it means 500 Hz polling */ if (ftdi_set_latency_timer(&ftdic, 2) < 0) { fprintf(stderr, "Failed to set latency timer (%s).\n", ftdi_get_error_string(&ftdic)); error(); } + ftdic_latency_set = true; + if (ftdi_set_bitmode(&ftdic, 0xff, BITMODE_MPSSE) < 0) { fprintf(stderr, "Failed set BITMODE_MPSSE on iCE FTDI USB device.\n"); error(); @@ -697,6 +710,7 @@ int main(int argc, char **argv) // --------------------------------------------------------- fprintf(stderr, "Bye.\n"); + ftdi_set_latency_timer(&ftdic, ftdi_latency); ftdi_disable_bitbang(&ftdic); ftdi_usb_close(&ftdic); ftdi_deinit(&ftdic); -- cgit v1.2.3