diff options
| author | Benjamin Herrenschmidt <benh@kernel.crashing.org> | 2018-06-03 20:07:49 +1000 |
|---|---|---|
| committer | Benjamin Herrenschmidt <benh@kernel.crashing.org> | 2018-06-03 20:07:49 +1000 |
| commit | fdff87f432c8be208323bd3ab8826b6468e15eda (patch) | |
| tree | 0607299e76a69e4e52c0b0cdf4b63883fea109d6 | |
| parent | fd19137cb3df0797c1681f2a7c4dc807da7cb7d9 (diff) | |
| download | cf-fsi-fdff87f432c8be208323bd3ab8826b6468e15eda.tar.gz cf-fsi-fdff87f432c8be208323bd3ab8826b6468e15eda.zip | |
Add break and "idle clocks" commands
Break sends a break command. It has 16000 recovery cycles as
per the existing GPIO based driver, though that might be
unnecessary in practice.
"idle clocks" sends up to 255 clocks with data line held high,
and can be used to flush things out for example after changing
the send delay, or before sending a DPOLL command as some CFAMs
seem to require extra clocks there.
Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org>
| -rw-r--r-- | cf-code/cf-fsi-fw.S | 38 | ||||
| -rw-r--r-- | cf-fsi-fw.h | 1 |
2 files changed, 39 insertions, 0 deletions
diff --git a/cf-code/cf-fsi-fw.S b/cf-code/cf-fsi-fw.S index f7bdcc6..67368f9 100644 --- a/cf-code/cf-fsi-fw.S +++ b/cf-code/cf-fsi-fw.S @@ -9,6 +9,10 @@ .equ CVIC_SW_IRQ_CLR, 0x1c .equ CVIC_SW_IRQ, 0x2 + .equ FSI_PRE_BREAK_CLOCKS, 50 /* Number clocks to prep for break */ + .equ FSI_BREAK_CLOCKS, 256 /* Number of clocks to issue break */ + .equ FSI_POST_BREAK_CLOCKS, 16000 /* Number clocks to set up cfam */ + /* Register usage * * A0 : sratch/temp @@ -221,6 +225,10 @@ main_loop: cmpi.b #CMD_BREAK,%d2 beq start_break + /* Idle clocks command ? */ + cmpi.b #CMD_IDLE_CLOCKS,%d2 + beq start_idle_clocks + /* Error */ move.b #STAT_ERR_INVAL_CMD,%a1@(STAT_REG) bra main_loop @@ -371,6 +379,36 @@ send_delay: bra main_loop start_break: + /* Clock some 1's to pace and flush out whatever's going on */ + move.l #FSI_PRE_BREAK_CLOCKS,%d3 + clock_out_zeros %d3 + + /* Clock out the break */ + moveq.l #0,%d0 + clock_out_bit %d0 + move.l #(FSI_BREAK_CLOCKS-1),%d3 +0: clock_toggle + subq.l #1,%d3 + bne 0b + + /* Clock some more 1's to resync (includes the send delay) */ + move.l #FSI_POST_BREAK_CLOCKS,%d3 + clock_out_zeros %d3 + + /* That's it */ + move.b #STAT_COMPLETE,%a1@(STAT_REG) + bra main_loop + +start_idle_clocks: + /* Shift command right to get bit count at bottom */ + lsr.l #8,%d2 + + /* Clock them out */ + moveq #0,%d3 + move.b %d2,%d3 + clock_out_zeros %d3 + + /* That's it */ move.b #STAT_COMPLETE,%a1@(STAT_REG) bra main_loop diff --git a/cf-fsi-fw.h b/cf-fsi-fw.h index db59efc..2d0e2ed 100644 --- a/cf-fsi-fw.h +++ b/cf-fsi-fw.h @@ -26,6 +26,7 @@ #define CMD_NONE 0x00 #define CMD_COMMAND 0x01 #define CMD_BREAK 0x02 +#define CMD_IDLE_CLOCKS 0x03 /* clen = #clocks */ #define CMD_INVALID 0xff #define CMD_REG_CLEN_MASK 0x0000ff00 #define CMD_REG_CLEN_SHIFT 8 |
