mirror of https://github.com/wwarthen/RomWBW.git
Wayne Warthen
10 years ago
42 changed files with 1009 additions and 3474 deletions
@ -0,0 +1,4 @@ |
|||
@echo off |
|||
setlocal |
|||
|
|||
pushd Prop && call Build && popd |
|||
@ -0,0 +1,5 @@ |
|||
@echo off |
|||
|
|||
setlocal |
|||
|
|||
pushd Prop && call Clean && popd |
|||
Binary file not shown.
@ -1,920 +0,0 @@ |
|||
{{ |
|||
SPI interface routines for SD & SDHC & MMC cards |
|||
|
|||
Jonathan "lonesock" Dummer |
|||
version 0.3.0 2009 July 19 |
|||
|
|||
Using multiblock SPI mode exclusively. |
|||
|
|||
This is the "SAFE" version...uses |
|||
* 1 instruction per bit writes |
|||
* 2 instructions per bit reads |
|||
|
|||
For the fsrw project: |
|||
fsrw.sf.net |
|||
}} |
|||
|
|||
CON |
|||
' possible card types |
|||
type_MMC = 1 |
|||
type_SD = 2 |
|||
type_SDHC = 3 |
|||
|
|||
' Error codes |
|||
ERR_CARD_NOT_RESET = -1 |
|||
ERR_3v3_NOT_SUPPORTED = -2 |
|||
ERR_OCR_FAILED = -3 |
|||
ERR_BLOCK_NOT_LONG_ALIGNED = -4 |
|||
'... |
|||
' These errors are for the assembly engine...they are negated inside, and need to be <= 511 |
|||
ERR_ASM_NO_READ_TOKEN = 100 |
|||
ERR_ASM_BLOCK_NOT_WRITTEN = 101 |
|||
' NOTE: errors -128 to -255 are reserved for reporting R1 response errors |
|||
'... |
|||
ERR_SPI_ENGINE_NOT_RUNNING = -999 |
|||
ERR_CARD_BUSY_TIMEOUT = -1000 |
|||
|
|||
' SDHC/SD/MMC command set for SPI |
|||
CMD0 = $40+0 ' GO_IDLE_STATE |
|||
CMD1 = $40+1 ' SEND_OP_COND (MMC) |
|||
ACMD41 = $C0+41 ' SEND_OP_COND (SDC) |
|||
CMD8 = $40+8 ' SEND_IF_COND |
|||
CMD9 = $40+9 ' SEND_CSD |
|||
CMD10 = $40+10 ' SEND_CID |
|||
CMD12 = $40+12 ' STOP_TRANSMISSION |
|||
CMD13 = $40+13 ' SEND_STATUS |
|||
ACMD13 = $C0+13 ' SD_STATUS (SDC) |
|||
CMD16 = $40+16 ' SET_BLOCKLEN |
|||
CMD17 = $40+17 ' READ_SINGLE_BLOCK |
|||
CMD18 = $40+18 ' READ_MULTIPLE_BLOCK |
|||
CMD23 = $40+23 ' SET_BLOCK_COUNT (MMC) |
|||
ACMD23 = $C0+23 ' SET_WR_BLK_ERASE_COUNT (SDC) |
|||
CMD24 = $40+24 ' WRITE_BLOCK |
|||
CMD25 = $40+25 ' WRITE_MULTIPLE_BLOCK |
|||
CMD55 = $40+55 ' APP_CMD |
|||
CMD58 = $40+58 ' READ_OCR |
|||
CMD59 = $40+59 ' CRC_ON_OFF |
|||
|
|||
' buffer size for my debug cmd log |
|||
'LOG_SIZE = 256<<1 |
|||
|
|||
{ |
|||
VAR |
|||
long SPI_engine_cog |
|||
' these are used for interfacing with the assembly engine | temporary initialization usage |
|||
long SPI_command ' "t", "r", "w", 0 =>done, <0 => error | pin mask |
|||
long SPI_block_index ' which 512-byte block to read/write | cnt at init |
|||
long SPI_buffer_address ' where to get/put the data in Hub RAM | unused |
|||
'} |
|||
DAT |
|||
'' I'm placing these variables in a DAT section to make this driver a singleton. |
|||
'' If for some reason you really need more than one driver (e.g. if you have more |
|||
'' than a single SD socket), move these back into VAR. |
|||
SPI_engine_cog long 0 |
|||
' these are used for interfacing with the assembly engine | temporary initialization usage |
|||
SPI_command long 0 ' "t", "r", "w", 0 =>done, <0 => error | unused |
|||
SPI_block_index long 0 ' which 512-byte block to read/write | cnt at init |
|||
SPI_buffer_address long 0 ' where to get/put the data in Hub RAM | unused |
|||
|
|||
{ |
|||
VAR |
|||
' for debug ONLY |
|||
byte log_cmd_resp[LOG_SIZE+1] |
|||
PUB get_log_pointer |
|||
return @log_cmd_resp |
|||
'} |
|||
|
|||
PUB start( basepin ) |
|||
{{ |
|||
This is a compatibility wrapper, and requires that the pins be |
|||
both consecutive, and in the order DO CLK DI CS. |
|||
}} |
|||
return start_explicit( basepin, basepin+1, basepin+2, basepin+3 ) |
|||
|
|||
PUB readblock( block_index, buffer_address ) |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
if (buffer_address & 3) |
|||
abort ERR_BLOCK_NOT_LONG_ALIGNED |
|||
SPI_block_index := block_index |
|||
SPI_buffer_address := buffer_address |
|||
SPI_command := "r" |
|||
repeat while SPI_command == "r" |
|||
if SPI_command < 0 |
|||
abort SPI_command |
|||
|
|||
PUB writeblock( block_index, buffer_address ) |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
if (buffer_address & 3) |
|||
abort ERR_BLOCK_NOT_LONG_ALIGNED |
|||
SPI_block_index := block_index |
|||
SPI_buffer_address := buffer_address |
|||
SPI_command := "w" |
|||
repeat while SPI_command == "w" |
|||
if SPI_command < 0 |
|||
abort SPI_command |
|||
|
|||
PUB get_seconds |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
SPI_command := "t" |
|||
repeat while SPI_command == "t" |
|||
' secods are in SPI_block_index, remainder is in SPI_buffer_address |
|||
return SPI_block_index |
|||
|
|||
PUB get_milliseconds : ms |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
SPI_command := "t" |
|||
repeat while SPI_command == "t" |
|||
' secods are in SPI_block_index, remainder is in SPI_buffer_address |
|||
ms := SPI_block_index * 1000 |
|||
ms += SPI_buffer_address * 1000 / clkfreq |
|||
|
|||
PUB start_explicit( DO, CLK, DI, CS ) : card_type | tmp, i |
|||
{{ |
|||
Do all of the card initialization in SPIN, then hand off the pin |
|||
information to the assembly cog for hot SPI block R/W action! |
|||
}} |
|||
' Start from scratch |
|||
stop |
|||
' clear my log buffer |
|||
{ |
|||
bytefill( @log_cmd_resp, 0, LOG_SIZE+1 ) |
|||
dbg_ptr := @log_cmd_resp |
|||
dbg_end := dbg_ptr + LOG_SIZE |
|||
'} |
|||
' wait ~4 milliseconds |
|||
waitcnt( 500 + (clkfreq>>8) + cnt ) |
|||
' (start with cog variables, _BEFORE_ loading the cog) |
|||
pinDO := DO |
|||
maskDO := |< DO |
|||
pinCLK := CLK |
|||
pinDI := DI |
|||
maskDI := |< DI |
|||
maskCS := |< CS |
|||
adrShift := 9 ' block = 512 * index, and 512 = 1<<9 |
|||
' pass the output pin mask via the command register |
|||
maskAll := maskCS | (|<pinCLK) | maskDI |
|||
dira |= maskAll |
|||
' get the card in a ready state: set DI and CS high, send => 74 clocks |
|||
outa |= maskAll |
|||
repeat 4096 |
|||
outa[CLK]~~ |
|||
outa[CLK]~ |
|||
' time-hack |
|||
SPI_block_index := cnt |
|||
' reset the card |
|||
tmp~ |
|||
repeat i from 0 to 9 |
|||
if tmp <> 1 |
|||
tmp := send_cmd_slow( CMD0, 0, $95 ) |
|||
if (tmp & 4) |
|||
' the card said CMD0 ("go idle") was invalid, so we're possibly stuck in read or write mode |
|||
if i & 1 |
|||
' exit multiblock read mode |
|||
repeat 4 |
|||
read_32_slow ' these extra clocks are required for some MMC cards |
|||
send_slow( $FD, 8 ) ' stop token |
|||
read_32_slow |
|||
repeat while read_slow <> $FF |
|||
else |
|||
' exit multiblock read mode |
|||
send_cmd_slow( CMD12, 0, $61 ) |
|||
if tmp <> 1 |
|||
' the reset command failed! |
|||
crash( ERR_CARD_NOT_RESET ) |
|||
' Is this a SD type 2 card? |
|||
if send_cmd_slow( CMD8, $1AA, $87 ) == 1 |
|||
' Type2 SD, check to see if it's a SDHC card |
|||
tmp := read_32_slow |
|||
' check the supported voltage |
|||
if (tmp & $1FF) <> $1AA |
|||
crash( ERR_3v3_NOT_SUPPORTED ) |
|||
' try to initialize the type 2 card with the High Capacity bit |
|||
repeat while send_cmd_slow( ACMD41, |<30, $77 ) |
|||
' the card is initialized, let's read back the High Capacity bit |
|||
if send_cmd_slow( CMD58, 0, $FD ) <> 0 |
|||
crash( ERR_OCR_FAILED ) |
|||
' get back the data |
|||
tmp := read_32_slow |
|||
' check the bit |
|||
if tmp & |<30 |
|||
card_type := type_SDHC |
|||
adrShift := 0 |
|||
else |
|||
card_type := type_SD |
|||
else |
|||
' Either a type 1 SD card, or it's MMC, try SD 1st |
|||
if send_cmd_slow( ACMD41, 0, $E5 ) < 2 |
|||
' this is a type 1 SD card (1 means busy, 0 means done initializing) |
|||
card_type := type_SD |
|||
repeat while send_cmd_slow( ACMD41, 0, $E5 ) |
|||
else |
|||
' mark that it's MMC, and try to initialize |
|||
card_type := type_MMC |
|||
repeat while send_cmd_slow( CMD1, 0, $F9 ) |
|||
' some SD or MMC cards may have the wrong block size, set it here |
|||
send_cmd_slow( CMD16, 512, $15 ) |
|||
' card is mounted, make sure the CRC is turned off |
|||
send_cmd_slow( CMD59, 0, $91 ) |
|||
' check the status |
|||
'send_cmd_slow( CMD13, 0, $0D ) |
|||
' done with the SPI bus for now |
|||
outa |= maskCS |
|||
' set my counter modes for super fast SPI operation |
|||
' writing: NCO single-ended mode, output on DI |
|||
writeMode := (%00100 << 26) | (DI << 0) |
|||
' reading |
|||
'readMode := (%11000 << 26) | (DO << 0) | (CLK << 9) |
|||
' clock |
|||
'clockLineMode := (%00110 << 26) | (CLK << 0) ' DUTY, 25% duty cycle |
|||
' clock |
|||
clockLineMode := (%00100 << 26) | (CLK << 0) ' NCO, 50% duty cycle |
|||
' how many bytes (8 clocks, >>3) fit into 1/2 of a second (>>1), 4 clocks per instruction (>>2)? |
|||
N_in8_500ms := clkfreq >> constant(1+2+3) |
|||
' how long should we wait before auto-exiting any multiblock mode? |
|||
idle_limit := 125 ' ms, NEVER make this > 1000 |
|||
idle_limit := clkfreq / (1000 / idle_limit) ' convert to counts |
|||
' Hand off control to the assembly engine's cog |
|||
bufAdr := @SPI_buffer_address |
|||
sdAdr := @SPI_block_index |
|||
SPI_command := 0 ' just make sure it's not 1 |
|||
' start my driver cog and wait till I hear back that it's done |
|||
SPI_engine_cog := cognew( @SPI_engine_entry, @SPI_command ) + 1 |
|||
if( SPI_engine_cog == 0 ) |
|||
crash( ERR_SPI_ENGINE_NOT_RUNNING ) |
|||
repeat while SPI_command <> -1 |
|||
' and we no longer need to control any pins from here |
|||
dira &= !maskAll |
|||
' the return variable is card_type |
|||
|
|||
PUB release |
|||
{{ |
|||
I do not want to abort if the cog is not |
|||
running, as this is called from stop, which |
|||
is called from start/ [8^) |
|||
}} |
|||
if SPI_engine_cog |
|||
SPI_command := "z" |
|||
repeat while SPI_command == "z" |
|||
|
|||
PUB stop |
|||
{{ |
|||
kill the assembly driver cog. |
|||
}} |
|||
release |
|||
if SPI_engine_cog |
|||
cogstop( SPI_engine_cog~ - 1 ) |
|||
|
|||
PRI crash( abort_code ) |
|||
{{ |
|||
In case of Bad Things(TM) happening, |
|||
exit as gracefully as possible. |
|||
}} |
|||
' and we no longer need to control any pins from here |
|||
dira &= !maskAll |
|||
' and report our error |
|||
abort abort_code |
|||
|
|||
PRI send_cmd_slow( cmd, val, crc ) : reply | time_stamp |
|||
{{ |
|||
Send down a command and return the reply. |
|||
Note: slow is an understatement! |
|||
Note: this uses the assembly DAT variables for pin IDs, |
|||
which means that if you run this multiple times (say for |
|||
multiple SD cards), these values will change for each one. |
|||
But this is OK as all of these functions will be called |
|||
during the initialization only, before the PASM engine is |
|||
running. |
|||
}} |
|||
' if this is an application specific command, handle it |
|||
if (cmd & $80) |
|||
' ACMD<n> is the command sequense of CMD55-CMD<n> |
|||
cmd &= $7F |
|||
reply := send_cmd_slow( CMD55, 0, $65 ) |
|||
if (reply > 1) |
|||
return reply |
|||
' the CS line needs to go low during this operation |
|||
outa |= maskCS |
|||
outa &= !maskCS |
|||
' give the card a few cocks to finish whatever it was doing |
|||
read_32_slow |
|||
' send the command byte |
|||
send_slow( cmd, 8 ) |
|||
' send the value long |
|||
send_slow( val, 32 ) |
|||
' send the CRC byte |
|||
send_slow( crc, 8 ) |
|||
' is this a CMD12?, if so, stuff byte |
|||
if cmd == CMD12 |
|||
read_slow |
|||
' read back the response (spec declares 1-8 reads max for SD, MMC is 0-8) |
|||
time_stamp := 9 |
|||
repeat |
|||
reply := read_slow |
|||
while( reply & $80 ) and ( time_stamp-- ) |
|||
' done, and 'reply' is already pre-loaded |
|||
{ |
|||
if dbg_ptr < (dbg_end-1) |
|||
byte[dbg_ptr++] := cmd |
|||
byte[dbg_ptr++] := reply |
|||
if (cmd&63) == 13 |
|||
' get the second byte |
|||
byte[dbg_ptr++] := cmd |
|||
byte[dbg_ptr++] := read_slow |
|||
'} |
|||
|
|||
PRI send_slow( value, bits_to_send ) |
|||
value ><= bits_to_send |
|||
repeat bits_to_send |
|||
outa[pinCLK]~ |
|||
outa[pinDI] := value |
|||
value >>= 1 |
|||
outa[pinCLK]~~ |
|||
|
|||
PRI read_32_slow : r |
|||
repeat 4 |
|||
r <<= 8 |
|||
r |= read_slow |
|||
|
|||
PRI read_slow : r |
|||
{{ |
|||
Read back 8 bits from the card |
|||
}} |
|||
' we need the DI line high so a read can occur |
|||
outa[pinDI]~~ |
|||
' get 8 bits (remember, r is initialized to 0 by SPIN) |
|||
repeat 8 |
|||
outa[pinCLK]~ |
|||
outa[pinCLK]~~ |
|||
r += r + ina[pinDO] |
|||
' error check |
|||
if( (cnt - SPI_block_index) > (clkfreq << 2) ) |
|||
crash( ERR_CARD_BUSY_TIMEOUT ) |
|||
|
|||
DAT |
|||
{{ |
|||
This is the assembly engine for doing fast block |
|||
reads and writes. This is *ALL* it does! |
|||
}} |
|||
ORG 0 |
|||
SPI_engine_entry |
|||
' Counter A drives data out |
|||
mov ctra,writeMode |
|||
' Counter B will always drive my clock line |
|||
mov ctrb,clockLineMode |
|||
' set our output pins to match the pin mask |
|||
mov dira,maskAll |
|||
' handshake that we now control the pins |
|||
neg user_request,#1 |
|||
wrlong user_request,par |
|||
' start my seconds' counter here |
|||
mov last_time,cnt |
|||
|
|||
waiting_for_command |
|||
' update my seconds counter, but also track the idle |
|||
' time so we can to release the card after timeout. |
|||
call #handle_time |
|||
' read the command, and make sure it's from the user (> 0) |
|||
rdlong user_request,par |
|||
cmps user_request,#0 wz,wc |
|||
if_be jmp #waiting_for_command |
|||
' handle our card based commands |
|||
cmp user_request,#"r" wz |
|||
if_z jmp #read_ahead |
|||
cmp user_request,#"w" wz |
|||
if_z jmp #write_behind |
|||
cmp user_request,#"z" wz |
|||
if_z jmp #release_card |
|||
' time requests are handled differently |
|||
cmp user_request,#"t" wz ' time |
|||
if_z wrlong seconds,sdAdr ' seconds goes into the SD index register |
|||
if_z wrlong dtime,bufAdr ' the remainder goes into the buffer address register |
|||
' in all other cases, clear the user's request |
|||
mov user_request,#0 |
|||
wrlong user_request,par |
|||
jmp #waiting_for_command |
|||
|
|||
|
|||
release_card |
|||
mov user_cmd,#"z" ' request a release |
|||
neg lastIndexPlus,#1 ' reset the last block index |
|||
neg user_idx,#1 ' and make this match it |
|||
call #handle_command |
|||
mov user_request,user_cmd |
|||
wrlong user_request,par |
|||
jmp #waiting_for_command |
|||
|
|||
read_ahead |
|||
rdlong user_idx,sdAdr |
|||
' if the correct block is not already loaded, load it |
|||
mov tmp1,user_idx |
|||
add tmp1,#1 |
|||
cmp tmp1,lastIndexPlus wz |
|||
if_z cmp lastCommand,#"r" wz |
|||
if_z jmp #:get_on_with_it |
|||
mov user_cmd,#"r" |
|||
call #handle_command |
|||
:get_on_with_it |
|||
' copy the data up into Hub RAM |
|||
movi transfer_long,#%000010_000 'set to wrlong |
|||
call #hub_cog_transfer |
|||
' signify that the data is ready, Spin can continue |
|||
mov user_request,user_cmd |
|||
wrlong user_request,par |
|||
' request the next block |
|||
mov user_cmd,#"r" |
|||
add user_idx,#1 |
|||
call #handle_command |
|||
' done |
|||
jmp #waiting_for_command |
|||
|
|||
write_behind |
|||
rdlong user_idx,sdAdr |
|||
' copy data in from Hub RAM |
|||
movi transfer_long,#%000010_001 'set to rdlong |
|||
call #hub_cog_transfer |
|||
' signify that we have the data, Spin can continue |
|||
mov user_request,user_cmd |
|||
wrlong user_request,par |
|||
' write out the block |
|||
mov user_cmd,#"w" |
|||
call #handle_command |
|||
' done |
|||
jmp #waiting_for_command |
|||
|
|||
{{ |
|||
Set user_cmd and user_idx before calling this |
|||
}} |
|||
handle_command |
|||
' Can we stay in the old mode? (address = old_address+1) && (old mode == new_mode) |
|||
cmp lastIndexPlus,user_idx wz |
|||
if_z cmp user_cmd,lastCommand wz |
|||
if_z jmp #:execute_block_command |
|||
' we fell through, must exit the old mode! (except if the old mode was "release") |
|||
cmp lastCommand,#"w" wz |
|||
if_z call #stop_mb_write |
|||
cmp lastCommand,#"r" wz |
|||
if_z call #stop_mb_read |
|||
' and start up the new mode! |
|||
cmp user_cmd,#"w" wz |
|||
if_z call #start_mb_write |
|||
cmp user_cmd,#"r" wz |
|||
if_z call #start_mb_read |
|||
cmp user_cmd,#"z" wz |
|||
if_z call #release_DO |
|||
:execute_block_command |
|||
' track the (new) last index and command |
|||
mov lastIndexPlus,user_idx |
|||
add lastIndexPlus,#1 |
|||
mov lastCommand,user_cmd |
|||
' do the block read or write or terminate! |
|||
cmp user_cmd,#"w" wz |
|||
if_z call #write_single_block |
|||
cmp user_cmd,#"r" wz |
|||
if_z call #read_single_block |
|||
cmp user_cmd,#"z" wz |
|||
if_z mov user_cmd,#0 |
|||
' done |
|||
handle_command_ret |
|||
ret |
|||
|
|||
{=== these PASM functions get me in and out of multiblock mode ===} |
|||
release_DO |
|||
' we're already out of multiblock mode, so |
|||
' deselect the card and send out some clocks |
|||
or outa,maskCS |
|||
call #in8 |
|||
call #in8 |
|||
' if you are using pull-up resistors, and need all |
|||
' lines tristated, then uncomment the following line. |
|||
' for Cluso99 |
|||
'mov dira,#0 |
|||
release_DO_ret |
|||
ret |
|||
|
|||
start_mb_read |
|||
movi block_cmd,#CMD18<<1 |
|||
call #send_SPI_command_fast |
|||
start_mb_read_ret |
|||
ret |
|||
|
|||
stop_mb_read |
|||
movi block_cmd,#CMD12<<1 |
|||
call #send_SPI_command_fast |
|||
call #busy_fast |
|||
stop_mb_read_ret |
|||
ret |
|||
|
|||
start_mb_write |
|||
movi block_cmd,#CMD25<<1 |
|||
call #send_SPI_command_fast |
|||
start_mb_write_ret |
|||
ret |
|||
|
|||
stop_mb_write |
|||
call #busy_fast |
|||
' only some cards need these extra clocks |
|||
mov tmp1,#16 |
|||
:loopity |
|||
call #in8 |
|||
djnz tmp1,#:loopity |
|||
' done with hack |
|||
movi phsa,#$FD<<1 |
|||
call #out8 |
|||
call #in8 ' stuff byte |
|||
call #busy_fast |
|||
stop_mb_write_ret |
|||
ret |
|||
|
|||
send_SPI_command_fast |
|||
' make sure we have control of the output lines |
|||
mov dira,maskAll |
|||
' make sure the CS line transitions low |
|||
or outa,maskCS |
|||
andn outa,maskCS |
|||
' 8 clocks |
|||
call #in8 |
|||
' send the data |
|||
mov phsa,block_cmd ' do which ever block command this is (already in the top 8 bits) |
|||
call #out8 ' write the byte |
|||
mov phsa,user_idx ' read in the desired block index |
|||
shl phsa,adrShift ' this will multiply by 512 (bytes/sector) for MMC and SD |
|||
call #out8 ' move out the 1st MSB ' |
|||
rol phsa,#1 |
|||
call #out8 ' move out the 1st MSB ' |
|||
rol phsa,#1 |
|||
call #out8 ' move out the 1st MSB ' |
|||
rol phsa,#1 |
|||
call #out8 ' move out the 1st MSB ' |
|||
' bogus CRC value |
|||
call #in8 ' in8 looks like out8 with $FF |
|||
' CMD12 requires a stuff byte |
|||
shr block_cmd,#24 |
|||
cmp block_cmd,#CMD12 wz |
|||
if_z call #in8 ' 8 clocks |
|||
' get the response |
|||
mov tmp1,#9 |
|||
:cmd_response |
|||
call #in8 |
|||
test readback,#$80 wc,wz |
|||
if_c djnz tmp1,#:cmd_response |
|||
if_nz neg user_cmd,readback |
|||
' done |
|||
send_SPI_command_fast_ret |
|||
ret |
|||
|
|||
|
|||
busy_fast |
|||
mov tmp1,N_in8_500ms |
|||
:still_busy |
|||
call #in8 |
|||
cmp readback,#$FF wz |
|||
if_nz djnz tmp1,#:still_busy |
|||
busy_fast_ret |
|||
ret |
|||
|
|||
|
|||
out8 |
|||
andn outa,maskDI |
|||
'movi phsb,#%11_0000000 |
|||
mov phsb,#0 |
|||
movi frqb,#%01_0000000 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
mov frqb,#0 |
|||
' don't shift out the final bit...already sent, but be aware |
|||
' of this when sending consecutive bytes (send_cmd, for e.g.) |
|||
out8_ret |
|||
ret |
|||
|
|||
{ |
|||
in8 |
|||
or outa,maskDI |
|||
mov ctra,readMode |
|||
' Start my clock |
|||
mov frqa,#1<<7 |
|||
mov phsa,#0 |
|||
movi phsb,#%11_0000000 |
|||
movi frqb,#%01_0000000 |
|||
' keep reading in my value, one bit at a time! (Kuneko - "Wh) |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
mov frqb,#0 ' stop the clock |
|||
mov readback,phsa |
|||
mov frqa,#0 |
|||
mov ctra,writeMode |
|||
in8_ret |
|||
ret |
|||
} |
|||
in8 |
|||
neg phsa,#1' DI high |
|||
mov readback,#0 |
|||
' set up my clock, and start it |
|||
movi phsb,#%011_000000 |
|||
movi frqb,#%001_000000 |
|||
' keep reading in my value |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
mov frqb,#0 ' stop the clock |
|||
rcl readback,#1 |
|||
mov phsa,#0 'DI low |
|||
in8_ret |
|||
ret |
|||
|
|||
|
|||
' this is called more frequently than 1 Hz, and |
|||
' is only called when the user command is 0. |
|||
handle_time |
|||
mov tmp1,cnt ' get the current timestamp |
|||
add idle_time,tmp1 ' add the current time to my idle time counter |
|||
sub idle_time,last_time ' subtract the last time from my idle counter (hence delta) |
|||
add dtime,tmp1 ' add to my accumulator, |
|||
sub dtime,last_time ' and subtract the old (adding delta) |
|||
mov last_time,tmp1 ' update my "last timestamp" |
|||
rdlong tmp1,#0 ' what is the clock frequency? |
|||
cmpsub dtime,tmp1 wc ' if I have more than a second in my accumulator |
|||
addx seconds,#0 ' then add it to "seconds" |
|||
' this part is to auto-release the card after a timeout |
|||
cmp idle_time,idle_limit wz,wc |
|||
if_b jmp #handle_time_ret ' don't clear if we haven't hit the limit |
|||
mov user_cmd,#"z" ' we can't overdo it, the command handler makes sure |
|||
neg lastIndexPlus,#1 ' reset the last block index |
|||
neg user_idx,#1 ' and make this match it |
|||
call #handle_command ' release the card, but don't mess with the user's request register |
|||
handle_time_ret |
|||
ret |
|||
|
|||
hub_cog_transfer |
|||
' setup for all 4 passes |
|||
mov ctrb,clockXferMode |
|||
mov frqb,#1 |
|||
rdlong buf_ptr,bufAdr |
|||
mov ops_left,#4 |
|||
movd transfer_long,#speed_buf |
|||
four_transfer_passes |
|||
' sync to the Hub RAM access |
|||
rdlong tmp1,tmp1 |
|||
' how many long to move on this pass? (512 bytes / 4)longs / 4 passes |
|||
mov tmp1,#(512 / 4 / 4) |
|||
' get my starting address right (phsb is incremented 1 per clock, so 16 each Hub access) |
|||
mov phsb,buf_ptr |
|||
' write the longs, stride 4...low 2 bits of phsb are ignored |
|||
transfer_long |
|||
rdlong 0-0,phsb |
|||
add transfer_long,incDest4 |
|||
djnz tmp1,#transfer_long |
|||
' go back to where I started, but advanced 1 long |
|||
sub transfer_long,decDestNminus1 |
|||
' offset my Hub pointer by one long per pass |
|||
add buf_ptr,#4 |
|||
' do all 4 passes |
|||
djnz ops_left,#four_transfer_passes |
|||
' restore the counter mode |
|||
mov frqb,#0 |
|||
mov phsb,#0 |
|||
mov ctrb,clockLineMode |
|||
hub_cog_transfer_ret |
|||
ret |
|||
|
|||
|
|||
read_single_block |
|||
' where am I sending the data? |
|||
movd :store_read_long,#speed_buf |
|||
mov ops_left,#128 |
|||
' wait until the card is ready |
|||
mov tmp1,N_in8_500ms |
|||
:get_resp |
|||
call #in8 |
|||
cmp readback,#$FE wz |
|||
if_nz djnz tmp1,#:get_resp |
|||
if_nz neg user_cmd,#ERR_ASM_NO_READ_TOKEN |
|||
if_nz jmp #read_single_block_ret |
|||
' set DI high |
|||
neg phsa,#1 |
|||
' read the data |
|||
mov ops_left,#128 |
|||
:read_loop |
|||
mov tmp1,#4 |
|||
movi phsb,#%011_000000 |
|||
:in_byte |
|||
' Start my clock |
|||
movi frqb,#%001_000000 |
|||
' keep reading in my value, BACKWARDS! (Brilliant idea by Tom Rokicki!) |
|||
test maskDO,ina wc |
|||
rcl readback,#8 |
|||
test maskDO,ina wc |
|||
muxc readback,#2 |
|||
test maskDO,ina wc |
|||
muxc readback,#4 |
|||
test maskDO,ina wc |
|||
muxc readback,#8 |
|||
test maskDO,ina wc |
|||
muxc readback,#16 |
|||
test maskDO,ina wc |
|||
muxc readback,#32 |
|||
test maskDO,ina wc |
|||
muxc readback,#64 |
|||
test maskDO,ina wc |
|||
mov frqb,#0 ' stop the clock |
|||
muxc readback,#128 |
|||
' go back for more |
|||
djnz tmp1,#:in_byte |
|||
' make it...NOT backwards [8^) |
|||
rev readback,#0 |
|||
:store_read_long |
|||
mov 0-0,readback ' due to some counter weirdness, we need this mov |
|||
add :store_read_long,const512 |
|||
djnz ops_left,#:read_loop |
|||
|
|||
' set DI low |
|||
mov phsa,#0 |
|||
|
|||
' now read 2 trailing bytes (CRC) |
|||
call #in8 ' out8 is 2x faster than in8 |
|||
call #in8 ' and I'm not using the CRC anyway |
|||
' give an extra 8 clocks in case we pause for a long time |
|||
call #in8 ' in8 looks like out8($FF) |
|||
|
|||
' all done successfully |
|||
mov idle_time,#0 |
|||
mov user_cmd,#0 |
|||
read_single_block_ret |
|||
ret |
|||
|
|||
write_single_block |
|||
' where am I getting the data? (all 512 bytes / 128 longs of it?) |
|||
movs :write_loop,#speed_buf |
|||
' read in 512 bytes (128 longs) from Hub RAM and write it to the card |
|||
mov ops_left,#128 |
|||
' just hold your horses |
|||
call #busy_fast |
|||
' $FC for multiblock, $FE for single block |
|||
movi phsa,#$FC<<1 |
|||
call #out8 |
|||
mov phsb,#0 ' make sure my clock accumulator is right |
|||
'movi phsb,#%11_0000000 |
|||
:write_loop |
|||
' read 4 bytes |
|||
mov phsa,speed_buf |
|||
add :write_loop,#1 |
|||
' a long in LE order is DCBA |
|||
rol phsa,#24 ' move A7 into position, so I can do the swizzled version |
|||
movi frqb,#%010000000 ' start the clock (remember A7 is already in place) |
|||
rol phsa,#1 ' A7 is going out, at the end of this instr, A6 is in place |
|||
rol phsa,#1 ' A5 |
|||
rol phsa,#1 ' A4 |
|||
rol phsa,#1 ' A3 |
|||
rol phsa,#1 ' A2 |
|||
rol phsa,#1 ' A1 |
|||
rol phsa,#1 ' A0 |
|||
rol phsa,#17 ' B7 |
|||
rol phsa,#1 ' B6 |
|||
rol phsa,#1 ' B5 |
|||
rol phsa,#1 ' B4 |
|||
rol phsa,#1 ' B3 |
|||
rol phsa,#1 ' B2 |
|||
rol phsa,#1 ' B1 |
|||
rol phsa,#1 ' B0 |
|||
rol phsa,#17 ' C7 |
|||
rol phsa,#1 ' C6 |
|||
rol phsa,#1 ' C5 |
|||
rol phsa,#1 ' C4 |
|||
rol phsa,#1 ' C3 |
|||
rol phsa,#1 ' C2 |
|||
rol phsa,#1 ' C1 |
|||
rol phsa,#1 ' C0 |
|||
rol phsa,#17 ' D7 |
|||
rol phsa,#1 ' D6 |
|||
rol phsa,#1 ' D5 |
|||
rol phsa,#1 ' D4 |
|||
rol phsa,#1 ' D3 |
|||
rol phsa,#1 ' D2 |
|||
rol phsa,#1 ' D1 |
|||
rol phsa,#1 ' D0 will be in place _after_ this instruction |
|||
mov frqb,#0 ' shuts the clock off, _after_ this instruction |
|||
djnz ops_left,#:write_loop |
|||
' write out my two (bogus, using $FF) CRC bytes |
|||
call #in8 |
|||
call #in8 |
|||
' now read response (I need this response, so can't spoof using out8) |
|||
call #in8 |
|||
and readback,#$1F |
|||
cmp readback,#5 wz |
|||
if_z mov user_cmd,#0 ' great |
|||
if_nz neg user_cmd,#ERR_ASM_BLOCK_NOT_WRITTEN ' oops |
|||
' send out another 8 clocks |
|||
call #in8 |
|||
' all done |
|||
mov idle_time,#0 |
|||
write_single_block_ret |
|||
ret |
|||
|
|||
|
|||
{=== Assembly Interface Variables ===} |
|||
pinDO long 0 ' pin is controlled by a counter |
|||
pinCLK long 0 ' pin is controlled by a counter |
|||
pinDI long 0 ' pin is controlled by a counter |
|||
maskDO long 0 ' mask for reading the DO line from the card |
|||
maskDI long 0 ' mask for setting the pin high while reading |
|||
maskCS long 0 ' mask = (1<<pin), and is controlled directly |
|||
maskAll long 0 |
|||
adrShift long 9 ' will be 0 for SDHC, 9 for MMC & SD |
|||
bufAdr long 0 ' where in Hub RAM is the buffer to copy to/from? |
|||
sdAdr long 0 ' where on the SD card does it read/write? |
|||
writeMode long 0 ' the counter setup in NCO single ended, clocking data out on pinDI |
|||
'clockOutMode long 0 ' the counter setup in NCO single ended, driving the clock line on pinCLK |
|||
N_in8_500ms long 1_000_000 ' used for timeout checking in PASM |
|||
'readMode long 0 |
|||
clockLineMode long 0 |
|||
clockXferMode long %11111 << 26 |
|||
const512 long 512 |
|||
const1024 long 1024 |
|||
incDest4 long 4 << 9 |
|||
decDestNminus1 long (512 / 4 - 1) << 9 |
|||
|
|||
{=== Initialized PASM Variables ===} |
|||
seconds long 0 |
|||
dtime long 0 |
|||
idle_time long 0 |
|||
idle_limit long 0 |
|||
|
|||
{=== Multiblock State Machine ===} |
|||
lastIndexPlus long -1 ' state handler will check against lastIndexPlus, which will not have been -1 |
|||
lastCommand long 0 ' this will never be the last command. |
|||
|
|||
{=== Debug Logging Pointers ===} |
|||
{ |
|||
dbg_ptr long 0 |
|||
dbg_end long 0 |
|||
'} |
|||
|
|||
{=== Assembly Scratch Variables ===} |
|||
ops_left res 1 ' used as a counter for bytes, words, longs, whatever (start w/ # byte clocks out) |
|||
readback res 1 ' all reading from the card goes through here |
|||
tmp1 res 1 ' this may get used in all subroutines...don't use except in lowest |
|||
user_request res 1 ' the main command variable, read in from Hub: "r"-read single, "w"-write single |
|||
user_cmd res 1 ' used internally to handle actual commands to be executed |
|||
user_idx res 1 ' the pointer to the Hub RAM where the data block is/goes |
|||
block_cmd res 1 ' one of the SD/MMC command codes, no app-specific allowed |
|||
buf_ptr res 1 ' moving pointer to the Hub RAM buffer |
|||
last_time res 1 ' tracking the timestamp |
|||
|
|||
{{ |
|||
496 longs is my total available space in the cog, |
|||
and I want 128 longs for eventual use as one 512- |
|||
byte buffer. This gives me a total of 368 longs |
|||
to use for umount, and a readblock and writeblock |
|||
for both Hub RAM and Cog buffers. |
|||
}} |
|||
speed_buf res 128 ' 512 bytes to be used for read-ahead / write-behind |
|||
|
|||
'fit 467 |
|||
FIT 496 |
|||
|
|||
'' MIT LICENSE |
|||
{{ |
|||
' Permission is hereby granted, free of charge, to any person obtaining |
|||
' a copy of this software and associated documentation files |
|||
' (the "Software"), to deal in the Software without restriction, |
|||
' including without limitation the rights to use, copy, modify, merge, |
|||
' publish, distribute, sublicense, and/or sell copies of the Software, |
|||
' and to permit persons to whom the Software is furnished to do so, |
|||
' subject to the following conditions: |
|||
' |
|||
' The above copyright notice and this permission notice shall be included |
|||
' in all copies or substantial portions of the Software. |
|||
' |
|||
' THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
|||
' EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
|||
' MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
|||
' IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY |
|||
' CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, |
|||
' TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE |
|||
' SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
|||
}} |
|||
Binary file not shown.
@ -0,0 +1,18 @@ |
|||
@echo off |
|||
setlocal |
|||
|
|||
set TOOLS=../../Tools |
|||
|
|||
set PATH=%TOOLS%\bst;%PATH% |
|||
|
|||
call :bstc PropIO || goto :eof |
|||
call :bstc PropIO2 || goto :eof |
|||
call :bstc ParPortProp || goto :eof |
|||
|
|||
goto :eof |
|||
|
|||
:bstc |
|||
echo. |
|||
echo Building %1... |
|||
bstc Spin\%1 -e -l |
|||
goto :eof |
|||
@ -0,0 +1,6 @@ |
|||
@echo off |
|||
|
|||
setlocal |
|||
|
|||
if exist *.eeprom del *.eeprom /Q |
|||
if exist *.list del *.list /Q |
|||
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
Binary file not shown.
@ -1,704 +0,0 @@ |
|||
'' VGA_1024.spin |
|||
'' |
|||
'' MODIFIED BY VINCE BRIEL FOR POCKETERM FEATURES |
|||
'' MODIIFED BY JEFF LEDGER / AKA OLDBITCOLLECTOR |
|||
'' |
|||
|
|||
CON |
|||
cols = 80 '128 ' number of screen columns |
|||
lcols = cols / 4 ' number of long in columns |
|||
rows = 40 '64 ' number of screen rows |
|||
chars = rows*cols ' number of screen characters |
|||
esc = $CB ' keyboard esc char |
|||
rowsnow = 36 ' adjusted for split screen effect |
|||
maxChars = rowsnow*cols ' adjusted value for split screen effect |
|||
lastChar = maxChars / 4 ' last screen position in longs adjusted for split |
|||
lastLine = (rowsnow - 1) * cols ' character position of last row |
|||
cols1 = 81 ' adjusted value for 80th character |
|||
TURQUOISE = $29 |
|||
|
|||
OBJ |
|||
vga : "vga_Hires_Text" |
|||
|
|||
VAR |
|||
byte screen[chars] ' screen character buffer |
|||
byte tmpl[cols] ' temporary line buffer |
|||
word colors[rows] ' color specs for each screen row (see ColorPtr description above) |
|||
byte cursor[6] ' cursor info array (see CursorPtr description above) |
|||
long sync, loc, xloc, yloc ' sync used by VGA routine, others are local screen pointers |
|||
long kbdreq ' global val of kbdflag |
|||
long BR[8] |
|||
long Brate |
|||
byte inverse |
|||
byte invs |
|||
byte state ' Current state of state machine |
|||
word pos ' Current Position on the screen |
|||
word oldpos ' Previous location of cursor before update |
|||
word regionTop, regionBot ' Scroll region top/bottom |
|||
long arg0 ' First argument of escape sequence |
|||
long arg1 ' Second argument of escape sequence |
|||
byte lastc ' Last displayed char |
|||
word statpos |
|||
long vgabasepin |
|||
|
|||
PUB start(BasePin) | i, char |
|||
vgabasepin := BasePin |
|||
|
|||
''init screen colors to gold on blue |
|||
repeat i from 0 to rows - 1 |
|||
colors[i] := $08F0 '$2804 (if you want cyan on blue) |
|||
|
|||
''init cursor attributes |
|||
cursor[2] := %110 ' init cursor to underscore with slow blink |
|||
BR[0]:=300 |
|||
BR[1]:=1200 |
|||
BR[2]:=2400 |
|||
BR[3]:=4800 |
|||
BR[4]:=9600 |
|||
BR[5]:=19200 |
|||
BR[6]:=38400 |
|||
BR[7]:=57600 |
|||
BR[8]:=115200 |
|||
xloc := cursor[0] := 0 |
|||
yloc := cursor[1] := 0 |
|||
loc := xloc + yloc*cols |
|||
|
|||
pos := 0 |
|||
regionTop := 0 |
|||
regionBot := 35 * cols |
|||
state := 0 |
|||
statpos := 37 * cols |
|||
|
|||
PUB vidon |
|||
if (!vga.start(vgabasepin, @screen, @colors, @cursor, @sync)) |
|||
return false |
|||
|
|||
waitcnt(clkfreq * 1 + cnt) 'wait 1 second for cogs to start |
|||
|
|||
|
|||
PUB vidoff |
|||
vga.stop |
|||
|
|||
|
|||
PUB inv(c) |
|||
inverse:=c |
|||
|
|||
PUB color(colorVal) | i |
|||
repeat i from 0 to rows - 1 |
|||
colors[i] := $0000 | colorVal |
|||
|
|||
PUB cursorset(c) | i |
|||
i:=%000 |
|||
if c == 1 |
|||
i:= %001 |
|||
if c == 2 |
|||
i:= %010 |
|||
if c == 3 |
|||
i:= %011 |
|||
if c == 4 |
|||
i:= %101 |
|||
if c == 5 |
|||
i:= %110 |
|||
if c == 6 |
|||
i:= %111 |
|||
if c == 7 |
|||
i:= %000 |
|||
cursor[2] := i |
|||
|
|||
PUB bin(value, digits) |
|||
|
|||
'' Print a binary number, specify number of digits |
|||
|
|||
repeat while digits > 32 |
|||
outc("0") |
|||
digits-- |
|||
|
|||
value <<= 32 - digits |
|||
|
|||
repeat digits |
|||
outc((value <-= 1) & 1 + "0") |
|||
|
|||
|
|||
PUB clrbtm(ColorVal) | i |
|||
repeat i from 36 to rows - 1 'was 35 |
|||
colors[i] := $0000 + ColorVal |
|||
|
|||
PUB cls1(c,screencolor,pcport,ascii,CR) | i,x,y |
|||
|
|||
longfill(@screen[0], $20202020, chars / 4) |
|||
|
|||
clrbtm(TURQUOISE) |
|||
|
|||
inverse := 1 |
|||
|
|||
statprint(36,0, string(" N8VEM PropIO | RomWBW v0.94")) |
|||
inverse := 0 |
|||
statprint(37,0, string(" ")) |
|||
statprint(38,0, string(" ")) |
|||
statprint(39,0, string(" ")) |
|||
|
|||
|
|||
{{ |
|||
x :=xloc |
|||
y := yloc |
|||
invs := inverse |
|||
''clrbtm(TURQUOISE) |
|||
longfill(@screen, $20202020, chars/4) |
|||
xloc := 0 |
|||
yloc :=0 |
|||
loc := xloc + yloc*cols |
|||
repeat 80 |
|||
outc(32) |
|||
xloc := 0 |
|||
yloc :=36 |
|||
loc := xloc + yloc*cols |
|||
inverse := 1 |
|||
str(string(" propIO V 0.91 ")) |
|||
inverse := 0 |
|||
str(string("Baud Rate: ")) |
|||
i:= BR[6] |
|||
dec(i) |
|||
str(string(" ")) |
|||
xloc := 18 |
|||
loc := xloc + yloc*cols |
|||
str(string("Color ")) |
|||
str(string("PC Port: ")) |
|||
if pcport == 1 |
|||
str(string("OFF ")) |
|||
if pcport == 0 |
|||
str(string("ON ")) |
|||
str(string(" Force 7 bit: ")) |
|||
if ascii == 0 |
|||
str(string("NO ")) |
|||
if ascii == 1 |
|||
str(string("YES ")) |
|||
str(string(" Cursor CR W/LF: ")) |
|||
if CR == 1 |
|||
str(string("YES")) |
|||
if CR == 0 |
|||
str(string("NO ")) |
|||
outc(13) |
|||
outc(10) |
|||
|
|||
inverse:=1 |
|||
xloc := 6 |
|||
loc := xloc + yloc*cols |
|||
str(string("F1")) |
|||
xloc := 19 |
|||
loc := xloc + yloc*cols |
|||
str(string("F2")) |
|||
xloc := 30 |
|||
loc := xloc + yloc*cols |
|||
str(string("F3")) |
|||
xloc := 46 |
|||
loc := xloc + yloc*cols |
|||
str(string("F4")) |
|||
xloc := 58 |
|||
loc := xloc + yloc*cols |
|||
str(string("F5")) |
|||
xloc := 70 |
|||
loc := xloc + yloc*cols |
|||
str(string("F6")) |
|||
inverse := invs |
|||
xloc := cursor[0] := x 'right & left was 0 |
|||
yloc := cursor[1] := y 'from top was 1 |
|||
loc := xloc + yloc*cols |
|||
}} |
|||
|
|||
PUB clsupdate(c,screencolor,PCPORT,ascii,CR) | i,x,y,locold |
|||
|
|||
invs := inverse |
|||
locold := loc |
|||
x := xloc |
|||
y := yloc |
|||
''(TURQUOISE) |
|||
xloc := 0 |
|||
yloc :=36 |
|||
loc := xloc + yloc*cols |
|||
inverse := 1 |
|||
str(string(" propIO V 0.81 ")) |
|||
inverse := 0 |
|||
xloc := 0 |
|||
yloc :=37 |
|||
loc := xloc + yloc*cols |
|||
str(string("Baud Rate: ")) |
|||
i:= BR[6] |
|||
dec(i) |
|||
str(string(" ")) |
|||
xloc := 18 |
|||
loc := xloc + yloc*cols |
|||
|
|||
str(string("Color ")) |
|||
str(string("PC Port: ")) |
|||
if pcport == 1 |
|||
str(string("OFF ")) |
|||
if pcport == 0 |
|||
str(string("ON ")) |
|||
str(string(" Force 7 bit: ")) |
|||
if ascii == 0 |
|||
str(string("NO ")) |
|||
if ascii == 1 |
|||
str(string("YES ")) |
|||
str(string(" Cursor CR W/LF: ")) |
|||
if CR == 1 |
|||
str(string("YES")) |
|||
if CR == 0 |
|||
str(string("NO ")) |
|||
xloc := 0 |
|||
yloc :=38 |
|||
loc := xloc + yloc*cols |
|||
inverse:=1 |
|||
xloc := 6 |
|||
loc := xloc + yloc*cols |
|||
str(string("F1")) |
|||
xloc := 19 |
|||
loc := xloc + yloc*cols |
|||
str(string("F2")) |
|||
xloc := 30 |
|||
loc := xloc + yloc*cols |
|||
str(string("F3")) |
|||
xloc := 46 |
|||
loc := xloc + yloc*cols |
|||
str(string("F4")) |
|||
xloc := 58 |
|||
loc := xloc + yloc*cols |
|||
str(string("F5")) |
|||
xloc := 70 |
|||
loc := xloc + yloc*cols |
|||
str(string("F6")) |
|||
inverse := invs |
|||
xloc := cursor[0] := x |
|||
yloc := cursor[1] := y |
|||
' loc := xloc + yloc*cols |
|||
loc := locold |
|||
|
|||
PUB dec(value) | i |
|||
|
|||
'' Print a decimal number |
|||
|
|||
if value < 0 |
|||
-value |
|||
outc("-") |
|||
|
|||
i := 1_000_000_000 |
|||
|
|||
repeat 10 |
|||
if value => i |
|||
outc(value/i + "0") |
|||
value //= i |
|||
result~~ |
|||
elseif result or i == 1 |
|||
outc("0") |
|||
i /= 10 |
|||
|
|||
PUB hex(value, digits) |
|||
|
|||
'' Print a hexadecimal number, specify number of digits |
|||
|
|||
repeat while digits > 8 |
|||
outc("0") |
|||
digits-- |
|||
|
|||
value <<= (8 - digits) << 2 |
|||
|
|||
repeat digits |
|||
outc(lookupz((value <-= 4) & $f : "0".."9", "A".."F")) |
|||
|
|||
|
|||
PUB str(string_ptr) |
|||
|
|||
'' Print a zero terminated string |
|||
|
|||
repeat strsize(string_ptr) |
|||
process_char(byte[string_ptr++]) |
|||
|
|||
PUB statprint(r, c, str1) | x, ptr |
|||
|
|||
ptr := r * cols + c |
|||
repeat x from 0 to STRSIZE(str1) - 1 |
|||
putc(ptr++, BYTE[str1 + x]) |
|||
|
|||
PUB statnum(r, c, num1) | i, ptr |
|||
|
|||
ptr := r * cols + c |
|||
|
|||
if num1 < 0 |
|||
-num1 |
|||
putc(ptr++,"-") |
|||
|
|||
i := 1_000_000_000 |
|||
|
|||
repeat 10 |
|||
if num1 => i |
|||
putc(ptr++, (num1/i +"0")) |
|||
num1 //= i |
|||
result~~ |
|||
elseif result or i == 1 |
|||
putc(ptr++, "0") |
|||
i /= 10 |
|||
|
|||
PUB putc(position, c) |
|||
if inverse |
|||
c |= $80 |
|||
screen[position] := c |
|||
|
|||
PUB cls |
|||
longfill (@screen, $20202020, lastChar) |
|||
|
|||
PUB fullcls |
|||
longfill(@screen, $20202020, 800) |
|||
|
|||
PUB setInverse(val) |
|||
inverse := val |
|||
|
|||
PUB setInv(c) |
|||
if c == 7 |
|||
setInverse(1) |
|||
else |
|||
setInverse(0) |
|||
|
|||
PUB clEOL(position) | count |
|||
count := cols - (position // cols) |
|||
bytefill(@screen + position, $20, count) |
|||
|
|||
PUB clBOL(position) | count |
|||
count := position // cols |
|||
bytefill(@screen + position - count, $20, count) |
|||
|
|||
PUB delLine(position) | src, count |
|||
position -= position // cols |
|||
|
|||
src := position + cols |
|||
|
|||
count := (maxChars - src) / 4 |
|||
|
|||
if count > 0 |
|||
longmove(@screen + position, @screen + src, count) |
|||
|
|||
longfill(@screen + lastLine, $20202020, lcols) |
|||
|
|||
PUB clEOS(position) |
|||
cleol(position) |
|||
position += cols - (position // cols) |
|||
repeat while position < maxChars |
|||
longfill(@screen + position, $20202020, lcols) |
|||
pos += cols |
|||
|
|||
PUB setCursorPos(position) |
|||
cursor[0] := position // cols |
|||
cursor[1] := position / cols |
|||
|
|||
PUB insLine(position) | base, nxt |
|||
base := position - (position // cols) |
|||
position := lastLine |
|||
repeat while position > base |
|||
nxt := position - cols |
|||
longmove(@screen + position, @screen + nxt, lcols) |
|||
position := nxt |
|||
clEOL(base) |
|||
|
|||
PUB insChar(position) | count |
|||
count := (cols - (position // cols)) - 1 |
|||
bytemove(@tmpl, @screen + position, count) |
|||
screen[position] := " " |
|||
bytemove(@screen + position + 1, @tmpl, count) |
|||
|
|||
PUB delChar(position) | count |
|||
count := (cols - (position // cols)) - 1 |
|||
bytemove(@screen + position, @screen + position + 1, count) |
|||
screen[position + count] := " " |
|||
|
|||
PRI inRegion : answer |
|||
answer := (pos => regionTop) AND (pos < regionBot) |
|||
|
|||
PRI scrollUp |
|||
delLine(regionTop) |
|||
if regionBot < maxChars |
|||
insLine(regionBot) |
|||
|
|||
PRI scrollDown |
|||
if regionBot < maxChars |
|||
delLine(regionBot) |
|||
insLine(regionTop) |
|||
|
|||
PRI ansi(c) | x, defVal |
|||
|
|||
state := 0 |
|||
|
|||
if (c <> "r") AND (c <> "J") AND (c <> "m") AND (c <> "K") |
|||
if arg0 == -1 |
|||
arg0 := 1 |
|||
if arg1 == -1 |
|||
arg1 := 1 |
|||
|
|||
case c |
|||
"@": |
|||
repeat while arg0-- > 0 |
|||
insChar(pos) |
|||
|
|||
"b": |
|||
repeat while arg0-- > 0 |
|||
outc(lastc) |
|||
|
|||
"d": |
|||
if (arg0 < 1) OR (arg0 > rows) |
|||
arg0 := rows |
|||
pos := ((arg0 - 1) * cols) + (pos // cols) |
|||
|
|||
"m": |
|||
setInv(arg0) |
|||
if arg1 <> -1 |
|||
setInv(arg1) |
|||
|
|||
"r": |
|||
if arg0 < 1 |
|||
arg0 := 1 |
|||
elseif arg0 > cols |
|||
arg0 := cols |
|||
if arg1 < 1 |
|||
arg1 := 1 |
|||
elseif arg1 > cols |
|||
arg1 := cols |
|||
if arg1 < arg0 |
|||
arg1 := arg0 |
|||
|
|||
regionTop := (arg0 - 1) * cols |
|||
regionBot := arg1 * cols |
|||
pos := 0 |
|||
|
|||
"A": |
|||
repeat while arg0-- > 0 |
|||
pos -= cols |
|||
if pos < 0 |
|||
pos += cols |
|||
return |
|||
|
|||
"B": |
|||
repeat while arg0-- > 0 |
|||
pos += cols |
|||
if pos => maxChars |
|||
pos -= cols |
|||
return |
|||
|
|||
"C": |
|||
repeat while arg0-- > 0 |
|||
pos += 1 |
|||
if pos => maxChars |
|||
pos -= 1 |
|||
return |
|||
|
|||
"D": |
|||
repeat while arg0-- > 0 |
|||
pos -= 1 |
|||
if pos < 0 |
|||
pos := 0 |
|||
return |
|||
|
|||
"G": |
|||
if (arg0 < 1) OR (arg0 > cols) |
|||
arg0 := cols |
|||
pos := (pos - (pos // cols)) + (arg0 - 1) |
|||
|
|||
"H", "f": |
|||
if arg0 =< 0 |
|||
arg0 := 1 |
|||
if arg1 =< 0 |
|||
arg1 := 1 |
|||
pos := (cols * (arg0 - 1)) + (arg1 - 1) |
|||
if pos < 0 |
|||
pos := 0 |
|||
if pos => maxChars |
|||
pos := maxChars - 1 |
|||
|
|||
"J": |
|||
if arg0 == 1 |
|||
clBOL(pos) |
|||
x := pos - cols |
|||
x -= x // cols |
|||
repeat while x => 0 |
|||
clEOL(x) |
|||
x -= cols |
|||
return |
|||
|
|||
if arg0 == 2 |
|||
pos := 0 |
|||
|
|||
clEOL(pos) |
|||
x := pos + cols |
|||
x -= (x // cols) |
|||
repeat while x < maxChars |
|||
clEOL(x) |
|||
x += cols |
|||
|
|||
"K": |
|||
if arg0 == -1 |
|||
clEOL(pos) |
|||
elseif arg0 == 1 |
|||
clBOL(pos) |
|||
else |
|||
clEOL(pos - (pos // cols)) |
|||
|
|||
"L": |
|||
if inRegion |
|||
repeat while arg0-- > 0 |
|||
if regionBot < maxChars |
|||
delLine(regionBot) |
|||
insLine(pos) |
|||
|
|||
"M": |
|||
if inRegion |
|||
repeat while arg0-- > 0 |
|||
delLine(pos) |
|||
if regionBot < maxChars |
|||
insLine(regionBot) |
|||
|
|||
"P": |
|||
repeat while arg0-- |
|||
delChar(pos) |
|||
|
|||
PRI outc(c) |
|||
|
|||
putc(pos++, lastc := c) |
|||
if pos == regionBot |
|||
scrollUp |
|||
pos -= cols |
|||
elseif pos == maxChars |
|||
pos := lastLine |
|||
|
|||
PUB process_char(c) |
|||
|
|||
case state |
|||
|
|||
0: |
|||
if c > 127 |
|||
c := $20 |
|||
|
|||
if c => $20 |
|||
outc(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == $1B |
|||
state := 1 |
|||
return |
|||
|
|||
if c == $0D |
|||
pos := pos - (pos // cols) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == $0A |
|||
if inRegion |
|||
pos += cols |
|||
if pos => regionBot |
|||
scrollUp |
|||
pos -= cols |
|||
else |
|||
pos += cols |
|||
if pos => maxChars |
|||
pos -= cols |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == 9 |
|||
pos += (8 - (pos // 8)) |
|||
|
|||
if pos => maxChars |
|||
pos := lastLine |
|||
delLine(0) |
|||
|
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == 8 |
|||
if pos > 0 |
|||
pos -= 1 |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
1: |
|||
case c |
|||
"[": |
|||
arg0 := arg1 := -1 |
|||
state := 2 |
|||
return |
|||
|
|||
"P": |
|||
pos += cols |
|||
if pos => maxChars |
|||
pos -= cols |
|||
|
|||
"K": |
|||
if pos > 0 |
|||
pos -= 1 |
|||
|
|||
"H": |
|||
pos -= cols |
|||
if pos < 0 |
|||
pos += cols |
|||
|
|||
"D": |
|||
if inRegion |
|||
scrollUp |
|||
|
|||
"M": |
|||
if inRegion |
|||
scrollDown |
|||
|
|||
"G": |
|||
pos := 0 |
|||
|
|||
"(": |
|||
state := 5 |
|||
return |
|||
|
|||
state := 0 |
|||
return |
|||
|
|||
2: |
|||
if (c => "0") AND (c =< "9") |
|||
if arg0 == -1 |
|||
arg0 := c - "0" |
|||
else |
|||
arg0 := (arg0 * 10) + (c - "0") |
|||
return |
|||
|
|||
if c == ";" |
|||
state := 3 |
|||
return |
|||
|
|||
ansi(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
3: |
|||
if (c => "0") AND (c =< "9") |
|||
if arg1 == -1 |
|||
arg1 := c - "0" |
|||
else |
|||
arg1 := (arg1 * 10) + (c - "0") |
|||
return |
|||
|
|||
if c == ";" |
|||
state := 4 |
|||
return |
|||
|
|||
ansi(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
4: |
|||
if (c => "0") AND (c =< "9") |
|||
return |
|||
|
|||
if c == ";" |
|||
return |
|||
ansi(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
5: |
|||
state := 0 |
|||
return |
|||
|
|||
return |
|||
Binary file not shown.
@ -1,920 +0,0 @@ |
|||
{{ |
|||
SPI interface routines for SD & SDHC & MMC cards |
|||
|
|||
Jonathan "lonesock" Dummer |
|||
version 0.3.0 2009 July 19 |
|||
|
|||
Using multiblock SPI mode exclusively. |
|||
|
|||
This is the "SAFE" version...uses |
|||
* 1 instruction per bit writes |
|||
* 2 instructions per bit reads |
|||
|
|||
For the fsrw project: |
|||
fsrw.sf.net |
|||
}} |
|||
|
|||
CON |
|||
' possible card types |
|||
type_MMC = 1 |
|||
type_SD = 2 |
|||
type_SDHC = 3 |
|||
|
|||
' Error codes |
|||
ERR_CARD_NOT_RESET = -1 |
|||
ERR_3v3_NOT_SUPPORTED = -2 |
|||
ERR_OCR_FAILED = -3 |
|||
ERR_BLOCK_NOT_LONG_ALIGNED = -4 |
|||
'... |
|||
' These errors are for the assembly engine...they are negated inside, and need to be <= 511 |
|||
ERR_ASM_NO_READ_TOKEN = 100 |
|||
ERR_ASM_BLOCK_NOT_WRITTEN = 101 |
|||
' NOTE: errors -128 to -255 are reserved for reporting R1 response errors |
|||
'... |
|||
ERR_SPI_ENGINE_NOT_RUNNING = -999 |
|||
ERR_CARD_BUSY_TIMEOUT = -1000 |
|||
|
|||
' SDHC/SD/MMC command set for SPI |
|||
CMD0 = $40+0 ' GO_IDLE_STATE |
|||
CMD1 = $40+1 ' SEND_OP_COND (MMC) |
|||
ACMD41 = $C0+41 ' SEND_OP_COND (SDC) |
|||
CMD8 = $40+8 ' SEND_IF_COND |
|||
CMD9 = $40+9 ' SEND_CSD |
|||
CMD10 = $40+10 ' SEND_CID |
|||
CMD12 = $40+12 ' STOP_TRANSMISSION |
|||
CMD13 = $40+13 ' SEND_STATUS |
|||
ACMD13 = $C0+13 ' SD_STATUS (SDC) |
|||
CMD16 = $40+16 ' SET_BLOCKLEN |
|||
CMD17 = $40+17 ' READ_SINGLE_BLOCK |
|||
CMD18 = $40+18 ' READ_MULTIPLE_BLOCK |
|||
CMD23 = $40+23 ' SET_BLOCK_COUNT (MMC) |
|||
ACMD23 = $C0+23 ' SET_WR_BLK_ERASE_COUNT (SDC) |
|||
CMD24 = $40+24 ' WRITE_BLOCK |
|||
CMD25 = $40+25 ' WRITE_MULTIPLE_BLOCK |
|||
CMD55 = $40+55 ' APP_CMD |
|||
CMD58 = $40+58 ' READ_OCR |
|||
CMD59 = $40+59 ' CRC_ON_OFF |
|||
|
|||
' buffer size for my debug cmd log |
|||
'LOG_SIZE = 256<<1 |
|||
|
|||
{ |
|||
VAR |
|||
long SPI_engine_cog |
|||
' these are used for interfacing with the assembly engine | temporary initialization usage |
|||
long SPI_command ' "t", "r", "w", 0 =>done, <0 => error | pin mask |
|||
long SPI_block_index ' which 512-byte block to read/write | cnt at init |
|||
long SPI_buffer_address ' where to get/put the data in Hub RAM | unused |
|||
'} |
|||
DAT |
|||
'' I'm placing these variables in a DAT section to make this driver a singleton. |
|||
'' If for some reason you really need more than one driver (e.g. if you have more |
|||
'' than a single SD socket), move these back into VAR. |
|||
SPI_engine_cog long 0 |
|||
' these are used for interfacing with the assembly engine | temporary initialization usage |
|||
SPI_command long 0 ' "t", "r", "w", 0 =>done, <0 => error | unused |
|||
SPI_block_index long 0 ' which 512-byte block to read/write | cnt at init |
|||
SPI_buffer_address long 0 ' where to get/put the data in Hub RAM | unused |
|||
|
|||
{ |
|||
VAR |
|||
' for debug ONLY |
|||
byte log_cmd_resp[LOG_SIZE+1] |
|||
PUB get_log_pointer |
|||
return @log_cmd_resp |
|||
'} |
|||
|
|||
PUB start( basepin ) |
|||
{{ |
|||
This is a compatibility wrapper, and requires that the pins be |
|||
both consecutive, and in the order DO CLK DI CS. |
|||
}} |
|||
return start_explicit( basepin, basepin+1, basepin+2, basepin+3 ) |
|||
|
|||
PUB readblock( block_index, buffer_address ) |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
if (buffer_address & 3) |
|||
abort ERR_BLOCK_NOT_LONG_ALIGNED |
|||
SPI_block_index := block_index |
|||
SPI_buffer_address := buffer_address |
|||
SPI_command := "r" |
|||
repeat while SPI_command == "r" |
|||
if SPI_command < 0 |
|||
abort SPI_command |
|||
|
|||
PUB writeblock( block_index, buffer_address ) |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
if (buffer_address & 3) |
|||
abort ERR_BLOCK_NOT_LONG_ALIGNED |
|||
SPI_block_index := block_index |
|||
SPI_buffer_address := buffer_address |
|||
SPI_command := "w" |
|||
repeat while SPI_command == "w" |
|||
if SPI_command < 0 |
|||
abort SPI_command |
|||
|
|||
PUB get_seconds |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
SPI_command := "t" |
|||
repeat while SPI_command == "t" |
|||
' secods are in SPI_block_index, remainder is in SPI_buffer_address |
|||
return SPI_block_index |
|||
|
|||
PUB get_milliseconds : ms |
|||
if SPI_engine_cog == 0 |
|||
abort ERR_SPI_ENGINE_NOT_RUNNING |
|||
SPI_command := "t" |
|||
repeat while SPI_command == "t" |
|||
' secods are in SPI_block_index, remainder is in SPI_buffer_address |
|||
ms := SPI_block_index * 1000 |
|||
ms += SPI_buffer_address * 1000 / clkfreq |
|||
|
|||
PUB start_explicit( DO, CLK, DI, CS ) : card_type | tmp, i |
|||
{{ |
|||
Do all of the card initialization in SPIN, then hand off the pin |
|||
information to the assembly cog for hot SPI block R/W action! |
|||
}} |
|||
' Start from scratch |
|||
stop |
|||
' clear my log buffer |
|||
{ |
|||
bytefill( @log_cmd_resp, 0, LOG_SIZE+1 ) |
|||
dbg_ptr := @log_cmd_resp |
|||
dbg_end := dbg_ptr + LOG_SIZE |
|||
'} |
|||
' wait ~4 milliseconds |
|||
waitcnt( 500 + (clkfreq>>8) + cnt ) |
|||
' (start with cog variables, _BEFORE_ loading the cog) |
|||
pinDO := DO |
|||
maskDO := |< DO |
|||
pinCLK := CLK |
|||
pinDI := DI |
|||
maskDI := |< DI |
|||
maskCS := |< CS |
|||
adrShift := 9 ' block = 512 * index, and 512 = 1<<9 |
|||
' pass the output pin mask via the command register |
|||
maskAll := maskCS | (|<pinCLK) | maskDI |
|||
dira |= maskAll |
|||
' get the card in a ready state: set DI and CS high, send => 74 clocks |
|||
outa |= maskAll |
|||
repeat 4096 |
|||
outa[CLK]~~ |
|||
outa[CLK]~ |
|||
' time-hack |
|||
SPI_block_index := cnt |
|||
' reset the card |
|||
tmp~ |
|||
repeat i from 0 to 9 |
|||
if tmp <> 1 |
|||
tmp := send_cmd_slow( CMD0, 0, $95 ) |
|||
if (tmp & 4) |
|||
' the card said CMD0 ("go idle") was invalid, so we're possibly stuck in read or write mode |
|||
if i & 1 |
|||
' exit multiblock read mode |
|||
repeat 4 |
|||
read_32_slow ' these extra clocks are required for some MMC cards |
|||
send_slow( $FD, 8 ) ' stop token |
|||
read_32_slow |
|||
repeat while read_slow <> $FF |
|||
else |
|||
' exit multiblock read mode |
|||
send_cmd_slow( CMD12, 0, $61 ) |
|||
if tmp <> 1 |
|||
' the reset command failed! |
|||
crash( ERR_CARD_NOT_RESET ) |
|||
' Is this a SD type 2 card? |
|||
if send_cmd_slow( CMD8, $1AA, $87 ) == 1 |
|||
' Type2 SD, check to see if it's a SDHC card |
|||
tmp := read_32_slow |
|||
' check the supported voltage |
|||
if (tmp & $1FF) <> $1AA |
|||
crash( ERR_3v3_NOT_SUPPORTED ) |
|||
' try to initialize the type 2 card with the High Capacity bit |
|||
repeat while send_cmd_slow( ACMD41, |<30, $77 ) |
|||
' the card is initialized, let's read back the High Capacity bit |
|||
if send_cmd_slow( CMD58, 0, $FD ) <> 0 |
|||
crash( ERR_OCR_FAILED ) |
|||
' get back the data |
|||
tmp := read_32_slow |
|||
' check the bit |
|||
if tmp & |<30 |
|||
card_type := type_SDHC |
|||
adrShift := 0 |
|||
else |
|||
card_type := type_SD |
|||
else |
|||
' Either a type 1 SD card, or it's MMC, try SD 1st |
|||
if send_cmd_slow( ACMD41, 0, $E5 ) < 2 |
|||
' this is a type 1 SD card (1 means busy, 0 means done initializing) |
|||
card_type := type_SD |
|||
repeat while send_cmd_slow( ACMD41, 0, $E5 ) |
|||
else |
|||
' mark that it's MMC, and try to initialize |
|||
card_type := type_MMC |
|||
repeat while send_cmd_slow( CMD1, 0, $F9 ) |
|||
' some SD or MMC cards may have the wrong block size, set it here |
|||
send_cmd_slow( CMD16, 512, $15 ) |
|||
' card is mounted, make sure the CRC is turned off |
|||
send_cmd_slow( CMD59, 0, $91 ) |
|||
' check the status |
|||
'send_cmd_slow( CMD13, 0, $0D ) |
|||
' done with the SPI bus for now |
|||
outa |= maskCS |
|||
' set my counter modes for super fast SPI operation |
|||
' writing: NCO single-ended mode, output on DI |
|||
writeMode := (%00100 << 26) | (DI << 0) |
|||
' reading |
|||
'readMode := (%11000 << 26) | (DO << 0) | (CLK << 9) |
|||
' clock |
|||
'clockLineMode := (%00110 << 26) | (CLK << 0) ' DUTY, 25% duty cycle |
|||
' clock |
|||
clockLineMode := (%00100 << 26) | (CLK << 0) ' NCO, 50% duty cycle |
|||
' how many bytes (8 clocks, >>3) fit into 1/2 of a second (>>1), 4 clocks per instruction (>>2)? |
|||
N_in8_500ms := clkfreq >> constant(1+2+3) |
|||
' how long should we wait before auto-exiting any multiblock mode? |
|||
idle_limit := 125 ' ms, NEVER make this > 1000 |
|||
idle_limit := clkfreq / (1000 / idle_limit) ' convert to counts |
|||
' Hand off control to the assembly engine's cog |
|||
bufAdr := @SPI_buffer_address |
|||
sdAdr := @SPI_block_index |
|||
SPI_command := 0 ' just make sure it's not 1 |
|||
' start my driver cog and wait till I hear back that it's done |
|||
SPI_engine_cog := cognew( @SPI_engine_entry, @SPI_command ) + 1 |
|||
if( SPI_engine_cog == 0 ) |
|||
crash( ERR_SPI_ENGINE_NOT_RUNNING ) |
|||
repeat while SPI_command <> -1 |
|||
' and we no longer need to control any pins from here |
|||
dira &= !maskAll |
|||
' the return variable is card_type |
|||
|
|||
PUB release |
|||
{{ |
|||
I do not want to abort if the cog is not |
|||
running, as this is called from stop, which |
|||
is called from start/ [8^) |
|||
}} |
|||
if SPI_engine_cog |
|||
SPI_command := "z" |
|||
repeat while SPI_command == "z" |
|||
|
|||
PUB stop |
|||
{{ |
|||
kill the assembly driver cog. |
|||
}} |
|||
release |
|||
if SPI_engine_cog |
|||
cogstop( SPI_engine_cog~ - 1 ) |
|||
|
|||
PRI crash( abort_code ) |
|||
{{ |
|||
In case of Bad Things(TM) happening, |
|||
exit as gracefully as possible. |
|||
}} |
|||
' and we no longer need to control any pins from here |
|||
dira &= !maskAll |
|||
' and report our error |
|||
abort abort_code |
|||
|
|||
PRI send_cmd_slow( cmd, val, crc ) : reply | time_stamp |
|||
{{ |
|||
Send down a command and return the reply. |
|||
Note: slow is an understatement! |
|||
Note: this uses the assembly DAT variables for pin IDs, |
|||
which means that if you run this multiple times (say for |
|||
multiple SD cards), these values will change for each one. |
|||
But this is OK as all of these functions will be called |
|||
during the initialization only, before the PASM engine is |
|||
running. |
|||
}} |
|||
' if this is an application specific command, handle it |
|||
if (cmd & $80) |
|||
' ACMD<n> is the command sequense of CMD55-CMD<n> |
|||
cmd &= $7F |
|||
reply := send_cmd_slow( CMD55, 0, $65 ) |
|||
if (reply > 1) |
|||
return reply |
|||
' the CS line needs to go low during this operation |
|||
outa |= maskCS |
|||
outa &= !maskCS |
|||
' give the card a few cocks to finish whatever it was doing |
|||
read_32_slow |
|||
' send the command byte |
|||
send_slow( cmd, 8 ) |
|||
' send the value long |
|||
send_slow( val, 32 ) |
|||
' send the CRC byte |
|||
send_slow( crc, 8 ) |
|||
' is this a CMD12?, if so, stuff byte |
|||
if cmd == CMD12 |
|||
read_slow |
|||
' read back the response (spec declares 1-8 reads max for SD, MMC is 0-8) |
|||
time_stamp := 9 |
|||
repeat |
|||
reply := read_slow |
|||
while( reply & $80 ) and ( time_stamp-- ) |
|||
' done, and 'reply' is already pre-loaded |
|||
{ |
|||
if dbg_ptr < (dbg_end-1) |
|||
byte[dbg_ptr++] := cmd |
|||
byte[dbg_ptr++] := reply |
|||
if (cmd&63) == 13 |
|||
' get the second byte |
|||
byte[dbg_ptr++] := cmd |
|||
byte[dbg_ptr++] := read_slow |
|||
'} |
|||
|
|||
PRI send_slow( value, bits_to_send ) |
|||
value ><= bits_to_send |
|||
repeat bits_to_send |
|||
outa[pinCLK]~ |
|||
outa[pinDI] := value |
|||
value >>= 1 |
|||
outa[pinCLK]~~ |
|||
|
|||
PRI read_32_slow : r |
|||
repeat 4 |
|||
r <<= 8 |
|||
r |= read_slow |
|||
|
|||
PRI read_slow : r |
|||
{{ |
|||
Read back 8 bits from the card |
|||
}} |
|||
' we need the DI line high so a read can occur |
|||
outa[pinDI]~~ |
|||
' get 8 bits (remember, r is initialized to 0 by SPIN) |
|||
repeat 8 |
|||
outa[pinCLK]~ |
|||
outa[pinCLK]~~ |
|||
r += r + ina[pinDO] |
|||
' error check |
|||
if( (cnt - SPI_block_index) > (clkfreq << 2) ) |
|||
crash( ERR_CARD_BUSY_TIMEOUT ) |
|||
|
|||
DAT |
|||
{{ |
|||
This is the assembly engine for doing fast block |
|||
reads and writes. This is *ALL* it does! |
|||
}} |
|||
ORG 0 |
|||
SPI_engine_entry |
|||
' Counter A drives data out |
|||
mov ctra,writeMode |
|||
' Counter B will always drive my clock line |
|||
mov ctrb,clockLineMode |
|||
' set our output pins to match the pin mask |
|||
mov dira,maskAll |
|||
' handshake that we now control the pins |
|||
neg user_request,#1 |
|||
wrlong user_request,par |
|||
' start my seconds' counter here |
|||
mov last_time,cnt |
|||
|
|||
waiting_for_command |
|||
' update my seconds counter, but also track the idle |
|||
' time so we can to release the card after timeout. |
|||
call #handle_time |
|||
' read the command, and make sure it's from the user (> 0) |
|||
rdlong user_request,par |
|||
cmps user_request,#0 wz,wc |
|||
if_be jmp #waiting_for_command |
|||
' handle our card based commands |
|||
cmp user_request,#"r" wz |
|||
if_z jmp #read_ahead |
|||
cmp user_request,#"w" wz |
|||
if_z jmp #write_behind |
|||
cmp user_request,#"z" wz |
|||
if_z jmp #release_card |
|||
' time requests are handled differently |
|||
cmp user_request,#"t" wz ' time |
|||
if_z wrlong seconds,sdAdr ' seconds goes into the SD index register |
|||
if_z wrlong dtime,bufAdr ' the remainder goes into the buffer address register |
|||
' in all other cases, clear the user's request |
|||
mov user_request,#0 |
|||
wrlong user_request,par |
|||
jmp #waiting_for_command |
|||
|
|||
|
|||
release_card |
|||
mov user_cmd,#"z" ' request a release |
|||
neg lastIndexPlus,#1 ' reset the last block index |
|||
neg user_idx,#1 ' and make this match it |
|||
call #handle_command |
|||
mov user_request,user_cmd |
|||
wrlong user_request,par |
|||
jmp #waiting_for_command |
|||
|
|||
read_ahead |
|||
rdlong user_idx,sdAdr |
|||
' if the correct block is not already loaded, load it |
|||
mov tmp1,user_idx |
|||
add tmp1,#1 |
|||
cmp tmp1,lastIndexPlus wz |
|||
if_z cmp lastCommand,#"r" wz |
|||
if_z jmp #:get_on_with_it |
|||
mov user_cmd,#"r" |
|||
call #handle_command |
|||
:get_on_with_it |
|||
' copy the data up into Hub RAM |
|||
movi transfer_long,#%000010_000 'set to wrlong |
|||
call #hub_cog_transfer |
|||
' signify that the data is ready, Spin can continue |
|||
mov user_request,user_cmd |
|||
wrlong user_request,par |
|||
' request the next block |
|||
mov user_cmd,#"r" |
|||
add user_idx,#1 |
|||
call #handle_command |
|||
' done |
|||
jmp #waiting_for_command |
|||
|
|||
write_behind |
|||
rdlong user_idx,sdAdr |
|||
' copy data in from Hub RAM |
|||
movi transfer_long,#%000010_001 'set to rdlong |
|||
call #hub_cog_transfer |
|||
' signify that we have the data, Spin can continue |
|||
mov user_request,user_cmd |
|||
wrlong user_request,par |
|||
' write out the block |
|||
mov user_cmd,#"w" |
|||
call #handle_command |
|||
' done |
|||
jmp #waiting_for_command |
|||
|
|||
{{ |
|||
Set user_cmd and user_idx before calling this |
|||
}} |
|||
handle_command |
|||
' Can we stay in the old mode? (address = old_address+1) && (old mode == new_mode) |
|||
cmp lastIndexPlus,user_idx wz |
|||
if_z cmp user_cmd,lastCommand wz |
|||
if_z jmp #:execute_block_command |
|||
' we fell through, must exit the old mode! (except if the old mode was "release") |
|||
cmp lastCommand,#"w" wz |
|||
if_z call #stop_mb_write |
|||
cmp lastCommand,#"r" wz |
|||
if_z call #stop_mb_read |
|||
' and start up the new mode! |
|||
cmp user_cmd,#"w" wz |
|||
if_z call #start_mb_write |
|||
cmp user_cmd,#"r" wz |
|||
if_z call #start_mb_read |
|||
cmp user_cmd,#"z" wz |
|||
if_z call #release_DO |
|||
:execute_block_command |
|||
' track the (new) last index and command |
|||
mov lastIndexPlus,user_idx |
|||
add lastIndexPlus,#1 |
|||
mov lastCommand,user_cmd |
|||
' do the block read or write or terminate! |
|||
cmp user_cmd,#"w" wz |
|||
if_z call #write_single_block |
|||
cmp user_cmd,#"r" wz |
|||
if_z call #read_single_block |
|||
cmp user_cmd,#"z" wz |
|||
if_z mov user_cmd,#0 |
|||
' done |
|||
handle_command_ret |
|||
ret |
|||
|
|||
{=== these PASM functions get me in and out of multiblock mode ===} |
|||
release_DO |
|||
' we're already out of multiblock mode, so |
|||
' deselect the card and send out some clocks |
|||
or outa,maskCS |
|||
call #in8 |
|||
call #in8 |
|||
' if you are using pull-up resistors, and need all |
|||
' lines tristated, then uncomment the following line. |
|||
' for Cluso99 |
|||
'mov dira,#0 |
|||
release_DO_ret |
|||
ret |
|||
|
|||
start_mb_read |
|||
movi block_cmd,#CMD18<<1 |
|||
call #send_SPI_command_fast |
|||
start_mb_read_ret |
|||
ret |
|||
|
|||
stop_mb_read |
|||
movi block_cmd,#CMD12<<1 |
|||
call #send_SPI_command_fast |
|||
call #busy_fast |
|||
stop_mb_read_ret |
|||
ret |
|||
|
|||
start_mb_write |
|||
movi block_cmd,#CMD25<<1 |
|||
call #send_SPI_command_fast |
|||
start_mb_write_ret |
|||
ret |
|||
|
|||
stop_mb_write |
|||
call #busy_fast |
|||
' only some cards need these extra clocks |
|||
mov tmp1,#16 |
|||
:loopity |
|||
call #in8 |
|||
djnz tmp1,#:loopity |
|||
' done with hack |
|||
movi phsa,#$FD<<1 |
|||
call #out8 |
|||
call #in8 ' stuff byte |
|||
call #busy_fast |
|||
stop_mb_write_ret |
|||
ret |
|||
|
|||
send_SPI_command_fast |
|||
' make sure we have control of the output lines |
|||
mov dira,maskAll |
|||
' make sure the CS line transitions low |
|||
or outa,maskCS |
|||
andn outa,maskCS |
|||
' 8 clocks |
|||
call #in8 |
|||
' send the data |
|||
mov phsa,block_cmd ' do which ever block command this is (already in the top 8 bits) |
|||
call #out8 ' write the byte |
|||
mov phsa,user_idx ' read in the desired block index |
|||
shl phsa,adrShift ' this will multiply by 512 (bytes/sector) for MMC and SD |
|||
call #out8 ' move out the 1st MSB ' |
|||
rol phsa,#1 |
|||
call #out8 ' move out the 1st MSB ' |
|||
rol phsa,#1 |
|||
call #out8 ' move out the 1st MSB ' |
|||
rol phsa,#1 |
|||
call #out8 ' move out the 1st MSB ' |
|||
' bogus CRC value |
|||
call #in8 ' in8 looks like out8 with $FF |
|||
' CMD12 requires a stuff byte |
|||
shr block_cmd,#24 |
|||
cmp block_cmd,#CMD12 wz |
|||
if_z call #in8 ' 8 clocks |
|||
' get the response |
|||
mov tmp1,#9 |
|||
:cmd_response |
|||
call #in8 |
|||
test readback,#$80 wc,wz |
|||
if_c djnz tmp1,#:cmd_response |
|||
if_nz neg user_cmd,readback |
|||
' done |
|||
send_SPI_command_fast_ret |
|||
ret |
|||
|
|||
|
|||
busy_fast |
|||
mov tmp1,N_in8_500ms |
|||
:still_busy |
|||
call #in8 |
|||
cmp readback,#$FF wz |
|||
if_nz djnz tmp1,#:still_busy |
|||
busy_fast_ret |
|||
ret |
|||
|
|||
|
|||
out8 |
|||
andn outa,maskDI |
|||
'movi phsb,#%11_0000000 |
|||
mov phsb,#0 |
|||
movi frqb,#%01_0000000 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
rol phsa,#1 |
|||
mov frqb,#0 |
|||
' don't shift out the final bit...already sent, but be aware |
|||
' of this when sending consecutive bytes (send_cmd, for e.g.) |
|||
out8_ret |
|||
ret |
|||
|
|||
{ |
|||
in8 |
|||
or outa,maskDI |
|||
mov ctra,readMode |
|||
' Start my clock |
|||
mov frqa,#1<<7 |
|||
mov phsa,#0 |
|||
movi phsb,#%11_0000000 |
|||
movi frqb,#%01_0000000 |
|||
' keep reading in my value, one bit at a time! (Kuneko - "Wh) |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
shr frqa,#1 |
|||
mov frqb,#0 ' stop the clock |
|||
mov readback,phsa |
|||
mov frqa,#0 |
|||
mov ctra,writeMode |
|||
in8_ret |
|||
ret |
|||
} |
|||
in8 |
|||
neg phsa,#1' DI high |
|||
mov readback,#0 |
|||
' set up my clock, and start it |
|||
movi phsb,#%011_000000 |
|||
movi frqb,#%001_000000 |
|||
' keep reading in my value |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
rcl readback,#1 |
|||
test maskDO,ina wc |
|||
mov frqb,#0 ' stop the clock |
|||
rcl readback,#1 |
|||
mov phsa,#0 'DI low |
|||
in8_ret |
|||
ret |
|||
|
|||
|
|||
' this is called more frequently than 1 Hz, and |
|||
' is only called when the user command is 0. |
|||
handle_time |
|||
mov tmp1,cnt ' get the current timestamp |
|||
add idle_time,tmp1 ' add the current time to my idle time counter |
|||
sub idle_time,last_time ' subtract the last time from my idle counter (hence delta) |
|||
add dtime,tmp1 ' add to my accumulator, |
|||
sub dtime,last_time ' and subtract the old (adding delta) |
|||
mov last_time,tmp1 ' update my "last timestamp" |
|||
rdlong tmp1,#0 ' what is the clock frequency? |
|||
cmpsub dtime,tmp1 wc ' if I have more than a second in my accumulator |
|||
addx seconds,#0 ' then add it to "seconds" |
|||
' this part is to auto-release the card after a timeout |
|||
cmp idle_time,idle_limit wz,wc |
|||
if_b jmp #handle_time_ret ' don't clear if we haven't hit the limit |
|||
mov user_cmd,#"z" ' we can't overdo it, the command handler makes sure |
|||
neg lastIndexPlus,#1 ' reset the last block index |
|||
neg user_idx,#1 ' and make this match it |
|||
call #handle_command ' release the card, but don't mess with the user's request register |
|||
handle_time_ret |
|||
ret |
|||
|
|||
hub_cog_transfer |
|||
' setup for all 4 passes |
|||
mov ctrb,clockXferMode |
|||
mov frqb,#1 |
|||
rdlong buf_ptr,bufAdr |
|||
mov ops_left,#4 |
|||
movd transfer_long,#speed_buf |
|||
four_transfer_passes |
|||
' sync to the Hub RAM access |
|||
rdlong tmp1,tmp1 |
|||
' how many long to move on this pass? (512 bytes / 4)longs / 4 passes |
|||
mov tmp1,#(512 / 4 / 4) |
|||
' get my starting address right (phsb is incremented 1 per clock, so 16 each Hub access) |
|||
mov phsb,buf_ptr |
|||
' write the longs, stride 4...low 2 bits of phsb are ignored |
|||
transfer_long |
|||
rdlong 0-0,phsb |
|||
add transfer_long,incDest4 |
|||
djnz tmp1,#transfer_long |
|||
' go back to where I started, but advanced 1 long |
|||
sub transfer_long,decDestNminus1 |
|||
' offset my Hub pointer by one long per pass |
|||
add buf_ptr,#4 |
|||
' do all 4 passes |
|||
djnz ops_left,#four_transfer_passes |
|||
' restore the counter mode |
|||
mov frqb,#0 |
|||
mov phsb,#0 |
|||
mov ctrb,clockLineMode |
|||
hub_cog_transfer_ret |
|||
ret |
|||
|
|||
|
|||
read_single_block |
|||
' where am I sending the data? |
|||
movd :store_read_long,#speed_buf |
|||
mov ops_left,#128 |
|||
' wait until the card is ready |
|||
mov tmp1,N_in8_500ms |
|||
:get_resp |
|||
call #in8 |
|||
cmp readback,#$FE wz |
|||
if_nz djnz tmp1,#:get_resp |
|||
if_nz neg user_cmd,#ERR_ASM_NO_READ_TOKEN |
|||
if_nz jmp #read_single_block_ret |
|||
' set DI high |
|||
neg phsa,#1 |
|||
' read the data |
|||
mov ops_left,#128 |
|||
:read_loop |
|||
mov tmp1,#4 |
|||
movi phsb,#%011_000000 |
|||
:in_byte |
|||
' Start my clock |
|||
movi frqb,#%001_000000 |
|||
' keep reading in my value, BACKWARDS! (Brilliant idea by Tom Rokicki!) |
|||
test maskDO,ina wc |
|||
rcl readback,#8 |
|||
test maskDO,ina wc |
|||
muxc readback,#2 |
|||
test maskDO,ina wc |
|||
muxc readback,#4 |
|||
test maskDO,ina wc |
|||
muxc readback,#8 |
|||
test maskDO,ina wc |
|||
muxc readback,#16 |
|||
test maskDO,ina wc |
|||
muxc readback,#32 |
|||
test maskDO,ina wc |
|||
muxc readback,#64 |
|||
test maskDO,ina wc |
|||
mov frqb,#0 ' stop the clock |
|||
muxc readback,#128 |
|||
' go back for more |
|||
djnz tmp1,#:in_byte |
|||
' make it...NOT backwards [8^) |
|||
rev readback,#0 |
|||
:store_read_long |
|||
mov 0-0,readback ' due to some counter weirdness, we need this mov |
|||
add :store_read_long,const512 |
|||
djnz ops_left,#:read_loop |
|||
|
|||
' set DI low |
|||
mov phsa,#0 |
|||
|
|||
' now read 2 trailing bytes (CRC) |
|||
call #in8 ' out8 is 2x faster than in8 |
|||
call #in8 ' and I'm not using the CRC anyway |
|||
' give an extra 8 clocks in case we pause for a long time |
|||
call #in8 ' in8 looks like out8($FF) |
|||
|
|||
' all done successfully |
|||
mov idle_time,#0 |
|||
mov user_cmd,#0 |
|||
read_single_block_ret |
|||
ret |
|||
|
|||
write_single_block |
|||
' where am I getting the data? (all 512 bytes / 128 longs of it?) |
|||
movs :write_loop,#speed_buf |
|||
' read in 512 bytes (128 longs) from Hub RAM and write it to the card |
|||
mov ops_left,#128 |
|||
' just hold your horses |
|||
call #busy_fast |
|||
' $FC for multiblock, $FE for single block |
|||
movi phsa,#$FC<<1 |
|||
call #out8 |
|||
mov phsb,#0 ' make sure my clock accumulator is right |
|||
'movi phsb,#%11_0000000 |
|||
:write_loop |
|||
' read 4 bytes |
|||
mov phsa,speed_buf |
|||
add :write_loop,#1 |
|||
' a long in LE order is DCBA |
|||
rol phsa,#24 ' move A7 into position, so I can do the swizzled version |
|||
movi frqb,#%010000000 ' start the clock (remember A7 is already in place) |
|||
rol phsa,#1 ' A7 is going out, at the end of this instr, A6 is in place |
|||
rol phsa,#1 ' A5 |
|||
rol phsa,#1 ' A4 |
|||
rol phsa,#1 ' A3 |
|||
rol phsa,#1 ' A2 |
|||
rol phsa,#1 ' A1 |
|||
rol phsa,#1 ' A0 |
|||
rol phsa,#17 ' B7 |
|||
rol phsa,#1 ' B6 |
|||
rol phsa,#1 ' B5 |
|||
rol phsa,#1 ' B4 |
|||
rol phsa,#1 ' B3 |
|||
rol phsa,#1 ' B2 |
|||
rol phsa,#1 ' B1 |
|||
rol phsa,#1 ' B0 |
|||
rol phsa,#17 ' C7 |
|||
rol phsa,#1 ' C6 |
|||
rol phsa,#1 ' C5 |
|||
rol phsa,#1 ' C4 |
|||
rol phsa,#1 ' C3 |
|||
rol phsa,#1 ' C2 |
|||
rol phsa,#1 ' C1 |
|||
rol phsa,#1 ' C0 |
|||
rol phsa,#17 ' D7 |
|||
rol phsa,#1 ' D6 |
|||
rol phsa,#1 ' D5 |
|||
rol phsa,#1 ' D4 |
|||
rol phsa,#1 ' D3 |
|||
rol phsa,#1 ' D2 |
|||
rol phsa,#1 ' D1 |
|||
rol phsa,#1 ' D0 will be in place _after_ this instruction |
|||
mov frqb,#0 ' shuts the clock off, _after_ this instruction |
|||
djnz ops_left,#:write_loop |
|||
' write out my two (bogus, using $FF) CRC bytes |
|||
call #in8 |
|||
call #in8 |
|||
' now read response (I need this response, so can't spoof using out8) |
|||
call #in8 |
|||
and readback,#$1F |
|||
cmp readback,#5 wz |
|||
if_z mov user_cmd,#0 ' great |
|||
if_nz neg user_cmd,#ERR_ASM_BLOCK_NOT_WRITTEN ' oops |
|||
' send out another 8 clocks |
|||
call #in8 |
|||
' all done |
|||
mov idle_time,#0 |
|||
write_single_block_ret |
|||
ret |
|||
|
|||
|
|||
{=== Assembly Interface Variables ===} |
|||
pinDO long 0 ' pin is controlled by a counter |
|||
pinCLK long 0 ' pin is controlled by a counter |
|||
pinDI long 0 ' pin is controlled by a counter |
|||
maskDO long 0 ' mask for reading the DO line from the card |
|||
maskDI long 0 ' mask for setting the pin high while reading |
|||
maskCS long 0 ' mask = (1<<pin), and is controlled directly |
|||
maskAll long 0 |
|||
adrShift long 9 ' will be 0 for SDHC, 9 for MMC & SD |
|||
bufAdr long 0 ' where in Hub RAM is the buffer to copy to/from? |
|||
sdAdr long 0 ' where on the SD card does it read/write? |
|||
writeMode long 0 ' the counter setup in NCO single ended, clocking data out on pinDI |
|||
'clockOutMode long 0 ' the counter setup in NCO single ended, driving the clock line on pinCLK |
|||
N_in8_500ms long 1_000_000 ' used for timeout checking in PASM |
|||
'readMode long 0 |
|||
clockLineMode long 0 |
|||
clockXferMode long %11111 << 26 |
|||
const512 long 512 |
|||
const1024 long 1024 |
|||
incDest4 long 4 << 9 |
|||
decDestNminus1 long (512 / 4 - 1) << 9 |
|||
|
|||
{=== Initialized PASM Variables ===} |
|||
seconds long 0 |
|||
dtime long 0 |
|||
idle_time long 0 |
|||
idle_limit long 0 |
|||
|
|||
{=== Multiblock State Machine ===} |
|||
lastIndexPlus long -1 ' state handler will check against lastIndexPlus, which will not have been -1 |
|||
lastCommand long 0 ' this will never be the last command. |
|||
|
|||
{=== Debug Logging Pointers ===} |
|||
{ |
|||
dbg_ptr long 0 |
|||
dbg_end long 0 |
|||
'} |
|||
|
|||
{=== Assembly Scratch Variables ===} |
|||
ops_left res 1 ' used as a counter for bytes, words, longs, whatever (start w/ # byte clocks out) |
|||
readback res 1 ' all reading from the card goes through here |
|||
tmp1 res 1 ' this may get used in all subroutines...don't use except in lowest |
|||
user_request res 1 ' the main command variable, read in from Hub: "r"-read single, "w"-write single |
|||
user_cmd res 1 ' used internally to handle actual commands to be executed |
|||
user_idx res 1 ' the pointer to the Hub RAM where the data block is/goes |
|||
block_cmd res 1 ' one of the SD/MMC command codes, no app-specific allowed |
|||
buf_ptr res 1 ' moving pointer to the Hub RAM buffer |
|||
last_time res 1 ' tracking the timestamp |
|||
|
|||
{{ |
|||
496 longs is my total available space in the cog, |
|||
and I want 128 longs for eventual use as one 512- |
|||
byte buffer. This gives me a total of 368 longs |
|||
to use for umount, and a readblock and writeblock |
|||
for both Hub RAM and Cog buffers. |
|||
}} |
|||
speed_buf res 128 ' 512 bytes to be used for read-ahead / write-behind |
|||
|
|||
'fit 467 |
|||
FIT 496 |
|||
|
|||
'' MIT LICENSE |
|||
{{ |
|||
' Permission is hereby granted, free of charge, to any person obtaining |
|||
' a copy of this software and associated documentation files |
|||
' (the "Software"), to deal in the Software without restriction, |
|||
' including without limitation the rights to use, copy, modify, merge, |
|||
' publish, distribute, sublicense, and/or sell copies of the Software, |
|||
' and to permit persons to whom the Software is furnished to do so, |
|||
' subject to the following conditions: |
|||
' |
|||
' The above copyright notice and this permission notice shall be included |
|||
' in all copies or substantial portions of the Software. |
|||
' |
|||
' THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
|||
' EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
|||
' MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
|||
' IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY |
|||
' CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, |
|||
' TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE |
|||
' SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. |
|||
}} |
|||
Binary file not shown.
@ -1 +0,0 @@ |
|||
{{
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
// E555 Speaker Engine
//
// Author: Kwabena W. Agyeman
// Updated: 7/27/2010
// Designed For: P8X32A
// Version: 1.1
//
// Copyright (c) 2010 Kwabena W. Agyeman
// See end of file for terms of use.
//
// Update History:
//
// v1.0 - Original release - 8/26/2009.
// v1.1 - Added support for variable pin assignments - 7/27/2010.
//
// For each included copy of this object only one spin interpreter should access it at a time.
//
// Nyamekye,
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
// Speaker Circuit:
//
// SpeakerPinNumber --- Speaker Driver (Active High).
//
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
}}
PUB speakerFrequency(newFrequency, speakerPinNumber) '' 10 Stack Longs
'' ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
'' // Changes the speaker frequency using the SPIN interpreter's counter modules.
'' //
'' // NewFrequency - The new frequency. Between 0 Hz and 80MHz @ 80MHz. -1 to reset the pin and counter modules.
'' // SpeakerPinNumber - Pin to use to drive the speaker circuit. Between 0 and 31.
'' ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
speakerSetup((newFrequency <> -1), speakerPinNumber)
newFrequency := ((newFrequency <# clkfreq) #> 0)
result := 1
repeat 32
newFrequency <<= 1
result <-= 1
if(newFrequency => clkfreq)
newFrequency -= clkfreq
result += 1
frqa := result~
phsb := 0
PUB speakerVolume(newVolume, speakerPinNumber) '' 10 Stack Longs
'' ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
'' // Changes the speaker volume using the SPIN interpreter's counter modules.
'' //
'' // NewVolume - The new volume. Between 0% and 100%. -1 to reset the pin and counter modules.
'' // SpeakerPinNumber - Pin to use to drive the speaker circuit. Between 0 and 31.
'' ////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
speakerSetup((newVolume <> -1), speakerPinNumber)
frqb := (((100 - ((newVolume <# 100) #> 0)) * constant(posx / 50)) | $7)
PRI speakerSetup(activeOrInactive, speakerPinNumber) ' 5 Stack Longs
speakerPinNumber := ((speakerPinNumber <# 31) #> 0)
dira[speakerPinNumber] := activeOrInactive
outa[speakerPinNumber] := false
ctra := ((constant(%0_0100 << 26) + speakerPinNumber) & activeOrInactive)
ctrb := ((constant(%0_0110 << 26) + speakerPinNumber) & activeOrInactive)
{{
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
// TERMS OF USE: MIT License
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
// Permission is hereby granted, free of charge, to any person obtaining a copy of this software and associated documentation
// files (the "Software"), to deal in the Software without restriction, including without limitation the rights to use, copy,
// modify, merge, publish, distribute, sublicense, and/or sell copies of the Software, and to permit persons to whom the
// Software is furnished to do so, subject to the following conditions:
//
// The above copyright notice and this permission notice shall be included in all copies or substantial portions of the
// Software.
//
// THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE
// WARRANTIES OF MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR
// COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
// ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
///////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////////
}} |
|||
Binary file not shown.
Binary file not shown.
@ -1,704 +0,0 @@ |
|||
'' VGA_1024.spin |
|||
'' |
|||
'' MODIFIED BY VINCE BRIEL FOR POCKETERM FEATURES |
|||
'' MODIIFED BY JEFF LEDGER / AKA OLDBITCOLLECTOR |
|||
'' |
|||
|
|||
CON |
|||
cols = 80 '128 ' number of screen columns |
|||
lcols = cols / 4 ' number of long in columns |
|||
rows = 40 '64 ' number of screen rows |
|||
chars = rows*cols ' number of screen characters |
|||
esc = $CB ' keyboard esc char |
|||
rowsnow = 36 ' adjusted for split screen effect |
|||
maxChars = rowsnow*cols ' adjusted value for split screen effect |
|||
lastChar = maxChars / 4 ' last screen position in longs adjusted for split |
|||
lastLine = (rowsnow - 1) * cols ' character position of last row |
|||
cols1 = 81 ' adjusted value for 80th character |
|||
TURQUOISE = $29 |
|||
|
|||
OBJ |
|||
vga : "vga_Hires_Text" |
|||
|
|||
VAR |
|||
byte screen[chars] ' screen character buffer |
|||
byte tmpl[cols] ' temporary line buffer |
|||
word colors[rows] ' color specs for each screen row (see ColorPtr description above) |
|||
byte cursor[6] ' cursor info array (see CursorPtr description above) |
|||
long sync, loc, xloc, yloc ' sync used by VGA routine, others are local screen pointers |
|||
long kbdreq ' global val of kbdflag |
|||
long BR[8] |
|||
long Brate |
|||
byte inverse |
|||
byte invs |
|||
byte state ' Current state of state machine |
|||
word pos ' Current Position on the screen |
|||
word oldpos ' Previous location of cursor before update |
|||
word regionTop, regionBot ' Scroll region top/bottom |
|||
long arg0 ' First argument of escape sequence |
|||
long arg1 ' Second argument of escape sequence |
|||
byte lastc ' Last displayed char |
|||
word statpos |
|||
long vgabasepin |
|||
|
|||
PUB start(BasePin) | i, char |
|||
vgabasepin := BasePin |
|||
|
|||
''init screen colors to gold on blue |
|||
repeat i from 0 to rows - 1 |
|||
colors[i] := $08F0 '$2804 (if you want cyan on blue) |
|||
|
|||
''init cursor attributes |
|||
cursor[2] := %110 ' init cursor to underscore with slow blink |
|||
BR[0]:=300 |
|||
BR[1]:=1200 |
|||
BR[2]:=2400 |
|||
BR[3]:=4800 |
|||
BR[4]:=9600 |
|||
BR[5]:=19200 |
|||
BR[6]:=38400 |
|||
BR[7]:=57600 |
|||
BR[8]:=115200 |
|||
xloc := cursor[0] := 0 |
|||
yloc := cursor[1] := 0 |
|||
loc := xloc + yloc*cols |
|||
|
|||
pos := 0 |
|||
regionTop := 0 |
|||
regionBot := 35 * cols |
|||
state := 0 |
|||
statpos := 37 * cols |
|||
|
|||
PUB vidon |
|||
if (!vga.start(vgabasepin, @screen, @colors, @cursor, @sync)) |
|||
return false |
|||
|
|||
waitcnt(clkfreq * 1 + cnt) 'wait 1 second for cogs to start |
|||
|
|||
|
|||
PUB vidoff |
|||
vga.stop |
|||
|
|||
|
|||
PUB inv(c) |
|||
inverse:=c |
|||
|
|||
PUB color(colorVal) | i |
|||
repeat i from 0 to rows - 1 |
|||
colors[i] := $0000 | colorVal |
|||
|
|||
PUB cursorset(c) | i |
|||
i:=%000 |
|||
if c == 1 |
|||
i:= %001 |
|||
if c == 2 |
|||
i:= %010 |
|||
if c == 3 |
|||
i:= %011 |
|||
if c == 4 |
|||
i:= %101 |
|||
if c == 5 |
|||
i:= %110 |
|||
if c == 6 |
|||
i:= %111 |
|||
if c == 7 |
|||
i:= %000 |
|||
cursor[2] := i |
|||
|
|||
PUB bin(value, digits) |
|||
|
|||
'' Print a binary number, specify number of digits |
|||
|
|||
repeat while digits > 32 |
|||
outc("0") |
|||
digits-- |
|||
|
|||
value <<= 32 - digits |
|||
|
|||
repeat digits |
|||
outc((value <-= 1) & 1 + "0") |
|||
|
|||
|
|||
PUB clrbtm(ColorVal) | i |
|||
repeat i from 36 to rows - 1 'was 35 |
|||
colors[i] := $0000 + ColorVal |
|||
|
|||
PUB cls1(c,screencolor,pcport,ascii,CR) | i,x,y |
|||
|
|||
longfill(@screen[0], $20202020, chars / 4) |
|||
|
|||
clrbtm(TURQUOISE) |
|||
|
|||
inverse := 1 |
|||
|
|||
statprint(36,0, string(" N8VEM PropIO V2 | RomWBW v0.94")) |
|||
inverse := 0 |
|||
statprint(37,0, string(" ")) |
|||
statprint(38,0, string(" ")) |
|||
statprint(39,0, string(" ")) |
|||
|
|||
|
|||
{{ |
|||
x :=xloc |
|||
y := yloc |
|||
invs := inverse |
|||
''clrbtm(TURQUOISE) |
|||
longfill(@screen, $20202020, chars/4) |
|||
xloc := 0 |
|||
yloc :=0 |
|||
loc := xloc + yloc*cols |
|||
repeat 80 |
|||
outc(32) |
|||
xloc := 0 |
|||
yloc :=36 |
|||
loc := xloc + yloc*cols |
|||
inverse := 1 |
|||
str(string(" propIO V 0.91 ")) |
|||
inverse := 0 |
|||
str(string("Baud Rate: ")) |
|||
i:= BR[6] |
|||
dec(i) |
|||
str(string(" ")) |
|||
xloc := 18 |
|||
loc := xloc + yloc*cols |
|||
str(string("Color ")) |
|||
str(string("PC Port: ")) |
|||
if pcport == 1 |
|||
str(string("OFF ")) |
|||
if pcport == 0 |
|||
str(string("ON ")) |
|||
str(string(" Force 7 bit: ")) |
|||
if ascii == 0 |
|||
str(string("NO ")) |
|||
if ascii == 1 |
|||
str(string("YES ")) |
|||
str(string(" Cursor CR W/LF: ")) |
|||
if CR == 1 |
|||
str(string("YES")) |
|||
if CR == 0 |
|||
str(string("NO ")) |
|||
outc(13) |
|||
outc(10) |
|||
|
|||
inverse:=1 |
|||
xloc := 6 |
|||
loc := xloc + yloc*cols |
|||
str(string("F1")) |
|||
xloc := 19 |
|||
loc := xloc + yloc*cols |
|||
str(string("F2")) |
|||
xloc := 30 |
|||
loc := xloc + yloc*cols |
|||
str(string("F3")) |
|||
xloc := 46 |
|||
loc := xloc + yloc*cols |
|||
str(string("F4")) |
|||
xloc := 58 |
|||
loc := xloc + yloc*cols |
|||
str(string("F5")) |
|||
xloc := 70 |
|||
loc := xloc + yloc*cols |
|||
str(string("F6")) |
|||
inverse := invs |
|||
xloc := cursor[0] := x 'right & left was 0 |
|||
yloc := cursor[1] := y 'from top was 1 |
|||
loc := xloc + yloc*cols |
|||
}} |
|||
|
|||
PUB clsupdate(c,screencolor,PCPORT,ascii,CR) | i,x,y,locold |
|||
|
|||
invs := inverse |
|||
locold := loc |
|||
x := xloc |
|||
y := yloc |
|||
''(TURQUOISE) |
|||
xloc := 0 |
|||
yloc :=36 |
|||
loc := xloc + yloc*cols |
|||
inverse := 1 |
|||
str(string(" propIO V 0.81 ")) |
|||
inverse := 0 |
|||
xloc := 0 |
|||
yloc :=37 |
|||
loc := xloc + yloc*cols |
|||
str(string("Baud Rate: ")) |
|||
i:= BR[6] |
|||
dec(i) |
|||
str(string(" ")) |
|||
xloc := 18 |
|||
loc := xloc + yloc*cols |
|||
|
|||
str(string("Color ")) |
|||
str(string("PC Port: ")) |
|||
if pcport == 1 |
|||
str(string("OFF ")) |
|||
if pcport == 0 |
|||
str(string("ON ")) |
|||
str(string(" Force 7 bit: ")) |
|||
if ascii == 0 |
|||
str(string("NO ")) |
|||
if ascii == 1 |
|||
str(string("YES ")) |
|||
str(string(" Cursor CR W/LF: ")) |
|||
if CR == 1 |
|||
str(string("YES")) |
|||
if CR == 0 |
|||
str(string("NO ")) |
|||
xloc := 0 |
|||
yloc :=38 |
|||
loc := xloc + yloc*cols |
|||
inverse:=1 |
|||
xloc := 6 |
|||
loc := xloc + yloc*cols |
|||
str(string("F1")) |
|||
xloc := 19 |
|||
loc := xloc + yloc*cols |
|||
str(string("F2")) |
|||
xloc := 30 |
|||
loc := xloc + yloc*cols |
|||
str(string("F3")) |
|||
xloc := 46 |
|||
loc := xloc + yloc*cols |
|||
str(string("F4")) |
|||
xloc := 58 |
|||
loc := xloc + yloc*cols |
|||
str(string("F5")) |
|||
xloc := 70 |
|||
loc := xloc + yloc*cols |
|||
str(string("F6")) |
|||
inverse := invs |
|||
xloc := cursor[0] := x |
|||
yloc := cursor[1] := y |
|||
' loc := xloc + yloc*cols |
|||
loc := locold |
|||
|
|||
PUB dec(value) | i |
|||
|
|||
'' Print a decimal number |
|||
|
|||
if value < 0 |
|||
-value |
|||
outc("-") |
|||
|
|||
i := 1_000_000_000 |
|||
|
|||
repeat 10 |
|||
if value => i |
|||
outc(value/i + "0") |
|||
value //= i |
|||
result~~ |
|||
elseif result or i == 1 |
|||
outc("0") |
|||
i /= 10 |
|||
|
|||
PUB hex(value, digits) |
|||
|
|||
'' Print a hexadecimal number, specify number of digits |
|||
|
|||
repeat while digits > 8 |
|||
outc("0") |
|||
digits-- |
|||
|
|||
value <<= (8 - digits) << 2 |
|||
|
|||
repeat digits |
|||
outc(lookupz((value <-= 4) & $f : "0".."9", "A".."F")) |
|||
|
|||
|
|||
PUB str(string_ptr) |
|||
|
|||
'' Print a zero terminated string |
|||
|
|||
repeat strsize(string_ptr) |
|||
process_char(byte[string_ptr++]) |
|||
|
|||
PUB statprint(r, c, str1) | x, ptr |
|||
|
|||
ptr := r * cols + c |
|||
repeat x from 0 to STRSIZE(str1) - 1 |
|||
putc(ptr++, BYTE[str1 + x]) |
|||
|
|||
PUB statnum(r, c, num1) | i, ptr |
|||
|
|||
ptr := r * cols + c |
|||
|
|||
if num1 < 0 |
|||
-num1 |
|||
putc(ptr++,"-") |
|||
|
|||
i := 1_000_000_000 |
|||
|
|||
repeat 10 |
|||
if num1 => i |
|||
putc(ptr++, (num1/i +"0")) |
|||
num1 //= i |
|||
result~~ |
|||
elseif result or i == 1 |
|||
putc(ptr++, "0") |
|||
i /= 10 |
|||
|
|||
PUB putc(position, c) |
|||
if inverse |
|||
c |= $80 |
|||
screen[position] := c |
|||
|
|||
PUB cls |
|||
longfill (@screen, $20202020, lastChar) |
|||
|
|||
PUB fullcls |
|||
longfill(@screen, $20202020, 800) |
|||
|
|||
PUB setInverse(val) |
|||
inverse := val |
|||
|
|||
PUB setInv(c) |
|||
if c == 7 |
|||
setInverse(1) |
|||
else |
|||
setInverse(0) |
|||
|
|||
PUB clEOL(position) | count |
|||
count := cols - (position // cols) |
|||
bytefill(@screen + position, $20, count) |
|||
|
|||
PUB clBOL(position) | count |
|||
count := position // cols |
|||
bytefill(@screen + position - count, $20, count) |
|||
|
|||
PUB delLine(position) | src, count |
|||
position -= position // cols |
|||
|
|||
src := position + cols |
|||
|
|||
count := (maxChars - src) / 4 |
|||
|
|||
if count > 0 |
|||
longmove(@screen + position, @screen + src, count) |
|||
|
|||
longfill(@screen + lastLine, $20202020, lcols) |
|||
|
|||
PUB clEOS(position) |
|||
cleol(position) |
|||
position += cols - (position // cols) |
|||
repeat while position < maxChars |
|||
longfill(@screen + position, $20202020, lcols) |
|||
pos += cols |
|||
|
|||
PUB setCursorPos(position) |
|||
cursor[0] := position // cols |
|||
cursor[1] := position / cols |
|||
|
|||
PUB insLine(position) | base, nxt |
|||
base := position - (position // cols) |
|||
position := lastLine |
|||
repeat while position > base |
|||
nxt := position - cols |
|||
longmove(@screen + position, @screen + nxt, lcols) |
|||
position := nxt |
|||
clEOL(base) |
|||
|
|||
PUB insChar(position) | count |
|||
count := (cols - (position // cols)) - 1 |
|||
bytemove(@tmpl, @screen + position, count) |
|||
screen[position] := " " |
|||
bytemove(@screen + position + 1, @tmpl, count) |
|||
|
|||
PUB delChar(position) | count |
|||
count := (cols - (position // cols)) - 1 |
|||
bytemove(@screen + position, @screen + position + 1, count) |
|||
screen[position + count] := " " |
|||
|
|||
PRI inRegion : answer |
|||
answer := (pos => regionTop) AND (pos < regionBot) |
|||
|
|||
PRI scrollUp |
|||
delLine(regionTop) |
|||
if regionBot < maxChars |
|||
insLine(regionBot) |
|||
|
|||
PRI scrollDown |
|||
if regionBot < maxChars |
|||
delLine(regionBot) |
|||
insLine(regionTop) |
|||
|
|||
PRI ansi(c) | x, defVal |
|||
|
|||
state := 0 |
|||
|
|||
if (c <> "r") AND (c <> "J") AND (c <> "m") AND (c <> "K") |
|||
if arg0 == -1 |
|||
arg0 := 1 |
|||
if arg1 == -1 |
|||
arg1 := 1 |
|||
|
|||
case c |
|||
"@": |
|||
repeat while arg0-- > 0 |
|||
insChar(pos) |
|||
|
|||
"b": |
|||
repeat while arg0-- > 0 |
|||
outc(lastc) |
|||
|
|||
"d": |
|||
if (arg0 < 1) OR (arg0 > rows) |
|||
arg0 := rows |
|||
pos := ((arg0 - 1) * cols) + (pos // cols) |
|||
|
|||
"m": |
|||
setInv(arg0) |
|||
if arg1 <> -1 |
|||
setInv(arg1) |
|||
|
|||
"r": |
|||
if arg0 < 1 |
|||
arg0 := 1 |
|||
elseif arg0 > cols |
|||
arg0 := cols |
|||
if arg1 < 1 |
|||
arg1 := 1 |
|||
elseif arg1 > cols |
|||
arg1 := cols |
|||
if arg1 < arg0 |
|||
arg1 := arg0 |
|||
|
|||
regionTop := (arg0 - 1) * cols |
|||
regionBot := arg1 * cols |
|||
pos := 0 |
|||
|
|||
"A": |
|||
repeat while arg0-- > 0 |
|||
pos -= cols |
|||
if pos < 0 |
|||
pos += cols |
|||
return |
|||
|
|||
"B": |
|||
repeat while arg0-- > 0 |
|||
pos += cols |
|||
if pos => maxChars |
|||
pos -= cols |
|||
return |
|||
|
|||
"C": |
|||
repeat while arg0-- > 0 |
|||
pos += 1 |
|||
if pos => maxChars |
|||
pos -= 1 |
|||
return |
|||
|
|||
"D": |
|||
repeat while arg0-- > 0 |
|||
pos -= 1 |
|||
if pos < 0 |
|||
pos := 0 |
|||
return |
|||
|
|||
"G": |
|||
if (arg0 < 1) OR (arg0 > cols) |
|||
arg0 := cols |
|||
pos := (pos - (pos // cols)) + (arg0 - 1) |
|||
|
|||
"H", "f": |
|||
if arg0 =< 0 |
|||
arg0 := 1 |
|||
if arg1 =< 0 |
|||
arg1 := 1 |
|||
pos := (cols * (arg0 - 1)) + (arg1 - 1) |
|||
if pos < 0 |
|||
pos := 0 |
|||
if pos => maxChars |
|||
pos := maxChars - 1 |
|||
|
|||
"J": |
|||
if arg0 == 1 |
|||
clBOL(pos) |
|||
x := pos - cols |
|||
x -= x // cols |
|||
repeat while x => 0 |
|||
clEOL(x) |
|||
x -= cols |
|||
return |
|||
|
|||
if arg0 == 2 |
|||
pos := 0 |
|||
|
|||
clEOL(pos) |
|||
x := pos + cols |
|||
x -= (x // cols) |
|||
repeat while x < maxChars |
|||
clEOL(x) |
|||
x += cols |
|||
|
|||
"K": |
|||
if arg0 == -1 |
|||
clEOL(pos) |
|||
elseif arg0 == 1 |
|||
clBOL(pos) |
|||
else |
|||
clEOL(pos - (pos // cols)) |
|||
|
|||
"L": |
|||
if inRegion |
|||
repeat while arg0-- > 0 |
|||
if regionBot < maxChars |
|||
delLine(regionBot) |
|||
insLine(pos) |
|||
|
|||
"M": |
|||
if inRegion |
|||
repeat while arg0-- > 0 |
|||
delLine(pos) |
|||
if regionBot < maxChars |
|||
insLine(regionBot) |
|||
|
|||
"P": |
|||
repeat while arg0-- |
|||
delChar(pos) |
|||
|
|||
PRI outc(c) |
|||
|
|||
putc(pos++, lastc := c) |
|||
if pos == regionBot |
|||
scrollUp |
|||
pos -= cols |
|||
elseif pos == maxChars |
|||
pos := lastLine |
|||
|
|||
PUB process_char(c) |
|||
|
|||
case state |
|||
|
|||
0: |
|||
if c > 127 |
|||
c := $20 |
|||
|
|||
if c => $20 |
|||
outc(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == $1B |
|||
state := 1 |
|||
return |
|||
|
|||
if c == $0D |
|||
pos := pos - (pos // cols) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == $0A |
|||
if inRegion |
|||
pos += cols |
|||
if pos => regionBot |
|||
scrollUp |
|||
pos -= cols |
|||
else |
|||
pos += cols |
|||
if pos => maxChars |
|||
pos -= cols |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == 9 |
|||
pos += (8 - (pos // 8)) |
|||
|
|||
if pos => maxChars |
|||
pos := lastLine |
|||
delLine(0) |
|||
|
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
if c == 8 |
|||
if pos > 0 |
|||
pos -= 1 |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
1: |
|||
case c |
|||
"[": |
|||
arg0 := arg1 := -1 |
|||
state := 2 |
|||
return |
|||
|
|||
"P": |
|||
pos += cols |
|||
if pos => maxChars |
|||
pos -= cols |
|||
|
|||
"K": |
|||
if pos > 0 |
|||
pos -= 1 |
|||
|
|||
"H": |
|||
pos -= cols |
|||
if pos < 0 |
|||
pos += cols |
|||
|
|||
"D": |
|||
if inRegion |
|||
scrollUp |
|||
|
|||
"M": |
|||
if inRegion |
|||
scrollDown |
|||
|
|||
"G": |
|||
pos := 0 |
|||
|
|||
"(": |
|||
state := 5 |
|||
return |
|||
|
|||
state := 0 |
|||
return |
|||
|
|||
2: |
|||
if (c => "0") AND (c =< "9") |
|||
if arg0 == -1 |
|||
arg0 := c - "0" |
|||
else |
|||
arg0 := (arg0 * 10) + (c - "0") |
|||
return |
|||
|
|||
if c == ";" |
|||
state := 3 |
|||
return |
|||
|
|||
ansi(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
3: |
|||
if (c => "0") AND (c =< "9") |
|||
if arg1 == -1 |
|||
arg1 := c - "0" |
|||
else |
|||
arg1 := (arg1 * 10) + (c - "0") |
|||
return |
|||
|
|||
if c == ";" |
|||
state := 4 |
|||
return |
|||
|
|||
ansi(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
4: |
|||
if (c => "0") AND (c =< "9") |
|||
return |
|||
|
|||
if c == ";" |
|||
return |
|||
ansi(c) |
|||
setCursorPos(pos) |
|||
return |
|||
|
|||
5: |
|||
state := 0 |
|||
return |
|||
|
|||
return |
|||
Binary file not shown.
Loading…
Reference in new issue