Fixed I2C start/stop #52

nofeletru · Dec 9, 2021 · 1405570 · 1405570
1 parent de48ed3
commit 1405570
Showing 1 changed file with 62 additions and 21 deletions.
diff --git a/software/ft232hhw.pas b/software/ft232hhw.pas
@@ -242,7 +242,7 @@ procedure TFT232HHardware.I2CInit;
   FT_Out_Buffer[5] := $8C; //Enable 3 phase data clock, used by I2C to allow data on both clock edges
 
   FT_Out_Buffer[6] := $9E; //Set I/O to only drive on a ‘0’ and tristate on a ‘1’
-  FT_Out_Buffer[7] := %00000011;
+  FT_Out_Buffer[7] := %00000111;
   FT_Out_Buffer[8] := $00;
   //Setting Port Data and Direction
   //Bits assigned on FT232H AD bus
@@ -349,42 +349,83 @@ function TFT232HHardware.I2CReadWrite(DevAddr: byte;
 end;
 
 procedure TFT232HHardware.I2CStart;
+var i, num: integer;
 begin
   if not FDevOpened then Exit;
 
-  FT_Out_Buffer[0] := $80; //MPSSE Command to set low bits of port
-  FT_Out_Buffer[1] := %00000011;
-  FT_Out_Buffer[2] := %00000011; //Pin directions
+  num := 0;
 
-  FT_Out_Buffer[3] := $80; //MPSSE Command to set low bits of port
-  FT_Out_Buffer[4] := %00000001;
-  FT_Out_Buffer[5] := %00000011; //Pin directions
+  for i:=0 to 3 do
+  begin
+    FT_Out_Buffer[num] := $80; //MPSSE Command to set low bits of port
+    inc(num);
+    FT_Out_Buffer[num] := %00000011;
+    inc(num);
+    FT_Out_Buffer[num] := %00000011; //Pin directions
+    inc(num);
+  end;
 
-  FT_Out_Buffer[6] := $80; //MPSSE Command to set low bits of port
-  FT_Out_Buffer[7] := %00000000;
-  FT_Out_Buffer[8] := %00000011; //Pin directions
+  for i:=0 to 3 do
+  begin
+    FT_Out_Buffer[num] := $80; //MPSSE Command to set low bits of port
+    inc(num);
+    FT_Out_Buffer[num] := %00000001;
+    inc(num);
+    FT_Out_Buffer[num] := %00000011; //Pin directions
+    inc(num);
+  end;
+
+  FT_Out_Buffer[num] := $80; //MPSSE Command to set low bits of port
+  inc(num);
+  FT_Out_Buffer[num] := %00000000;
+  inc(num);
+  FT_Out_Buffer[num] := %00000011; //Pin directions
+  inc(num);
 
-  Write_USB_Device_Buffer(9);
+  Write_USB_Device_Buffer(num);
 
 end;
 
 procedure TFT232HHardware.I2CStop;
+var i, num: integer;
 begin
   if not FDevOpened then Exit;
 
-  FT_Out_Buffer[0] := $80; //MPSSE Command to set low bits of port
-  FT_Out_Buffer[1] := %00000001;
-  FT_Out_Buffer[2] := %00000011; //Pin directions
+  num := 0;
+
+  for i:=0 to 3 do
+  begin
+    FT_Out_Buffer[num] := $80; //MPSSE Command to set low bits of port
+    inc(num);
+    FT_Out_Buffer[num] := %00000000;
+    inc(num);
+    FT_Out_Buffer[num] := %00000011; //Pin directions
+    inc(num);
+  end;
+
+  for i:=0 to 3 do
+  begin
+    FT_Out_Buffer[num] := $80; //MPSSE Command to set low bits of port
+    inc(num);
+    FT_Out_Buffer[num] := %00000001;
+    inc(num);
+    FT_Out_Buffer[num] := %00000011; //Pin directions
+    inc(num);
+  end;
+
+  for i:=0 to 3 do
+  begin
+    FT_Out_Buffer[num] := $80; //MPSSE Command to set low bits of port
+    inc(num);
+    FT_Out_Buffer[num] := %00000011;
+    inc(num);
+    FT_Out_Buffer[num] := %00000011; //Pin directions
+    inc(num);
+  end;
 
-  FT_Out_Buffer[3] := $80; //MPSSE Command to set low bits of port
-  FT_Out_Buffer[4] := %00000011;
-  FT_Out_Buffer[5] := %00000011; //Pin directions
 
-  FT_Out_Buffer[6] := $80; //MPSSE Command to set low bits of port
-  FT_Out_Buffer[7] := %00000000;
-  FT_Out_Buffer[8] := %00000011; //Pin directions
 
-  Write_USB_Device_Buffer(9);
+  Write_USB_Device_Buffer(num);
 
 end;