marfrit/ku1255cfw
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Add debug function for writing I2C data to trackpoint

Browse Source
This commit is contained in:
Tobias Diedrich
2022-01-23 16:41:44 +01:00
parent e1c342b8e6
commit a264ecbc27
1 changed files with 28 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files
main.s
+28 -1
View File
@@ -1739,6 +1739,8 @@ _setup_dispatch_table:
JMP _usb_htd_vend_write_ram
DW 0xc092
JMP _usb_dth_vend_read_i2c
DW 0x4093
JMP _usb_htd_vend_write_i2c
DW 0xc094
JMP _usb_dth_vend_read_code
DW 0xFFFF
@@ -2239,10 +2241,35 @@ _usb_dth_vend_read_code:
RET
_usb_dth_vend_read_i2c:
MOV A, #0x21 ; Write 1 byte
MOV A, #0
B0MOV UDP0, A
CALL _i2c_tp_read
B0MOV A, tpData0
B0MOV UDR0_W, A
INCMS UDP0
B0MOV A, tpData1
B0MOV UDR0_W, A
INCMS UDP0
B0MOV A, tpData2
B0MOV UDR0_W, A
INCMS UDP0
B0MOV A, tpData3
B0MOV UDR0_W, A
INCMS UDP0
B0MOV A, tpData4
B0MOV UDR0_W, A
INCMS UDP0
MOV A, #0x25 ; Write 5 byte
B0MOV UE0R, A
RET
_usb_htd_vend_write_i2c:
B0MOV A, wValueLo
CALL _i2c_tp_write
JMP _usb_write_ep0
_usb_htd_set_configuration:
; Only one configuration, nothing to do.
MOV A, #0x20 ; ACK with no TX