summaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--src/jtag/ft2232.c48
1 files changed, 48 insertions, 0 deletions
diff --git a/src/jtag/ft2232.c b/src/jtag/ft2232.c
index 68de086f..f5453a30 100644
--- a/src/jtag/ft2232.c
+++ b/src/jtag/ft2232.c
@@ -61,6 +61,8 @@
int ft2232_execute_queue(void);
int ft2232_speed(int speed);
+int ft2232_speed_div(int speed, int *khz);
+int ft2232_khz(int khz, int *jtag_speed);
int ft2232_register_commands(struct command_context_s *cmd_ctx);
int ft2232_init(void);
int ft2232_quit(void);
@@ -157,6 +159,9 @@ jtag_interface_t ft2232_interface =
.execute_queue = ft2232_execute_queue,
.speed = ft2232_speed,
+ .speed_div = ft2232_speed_div,
+ .khz = ft2232_khz,
+
.register_commands = ft2232_register_commands,
.init = ft2232_init,
.quit = ft2232_quit,
@@ -259,6 +264,49 @@ int ft2232_speed(int speed)
return ERROR_OK;
}
+int ft2232_speed_div(int speed, int *khz)
+{
+ /*
+ * Take a look in the FT2232 manual,
+ * AN2232C-01 Command Processor for
+ * MPSSE and MCU Host Bus. Chapter 3.8
+ */
+ *khz = 6000 / (1+speed);
+
+ return ERROR_OK;
+}
+
+int ft2232_khz(int khz, int *jtag_speed)
+{
+ /*
+ * Take a look in the FT2232 manual,
+ * AN2232C-01 Command Processor for
+ * MPSSE and MCU Host Bus. Chapter 3.8
+ *
+ * We will calc here with a multiplier
+ * of 10 for better rounding later.
+ */
+
+ /* Calc speed, (6000 / khz) - 1 */
+ *jtag_speed = (60000 / khz) - 10;
+
+ /* Add 0.5 for rounding */
+ *jtag_speed += 5;
+
+ /* Calc real speed */
+ *jtag_speed = *jtag_speed / 10;
+
+ /* Check if speed is greater than 0 */
+ if (*jtag_speed < 0)
+ {
+ *jtag_speed = 0;
+ }
+
+ return ERROR_OK;
+}
+
+
+
int ft2232_register_commands(struct command_context_s *cmd_ctx)
{
register_command(cmd_ctx, NULL, "ft2232_device_desc", ft2232_handle_device_desc_command,