歡迎您光臨本站 登入註冊首頁

AVR與CF卡(IDE)介面

admin @ 2014-03-25 , reply:0

概述

;***************************************************************************;;FileName :'cf.asm……

;***************************************************************************
;
; File Name  :'cf.asm"
; Title   :Compact Flash Common Memory Mode Driver
; Date   :2004.05.12.
; Version  :1.0.0
; Support telephone :+36-70-333-4034,  old: +36-30-9541-658 VFX
; Support fax  :
; Support Email  :info@vfx.hu
; Target MCU  :AVR
;
;***************************************************************************
; D E S C R I P T I O N
;
; Memory Interface to a compact flash card.
; Compact flash card is used in memory mapped mode.
; Registers are located at ADR_CFC in external RAM space of Mega128
;
;
;***************************************************************************
; M O D I F I C A T I O N   H I S T O R Y
;
;
;       rev.      date      who   why
; ---- ----------  ---  ------------------------------------
; 0.01 2004.05.12  VFX  Creation
;
;***************************************************************************
;Hardware
;***************************************************************************
;*
;* SYSCLK: f=16.000 MHz (T= 62.5 ns)
;*
;***************************************************************************
;
;
;**************************************************************************
;* Hardware Def.
;
; CompactFlash hardware definitions
; Table 34: Memory Mapped Decoding
; -REG A10 A9-A4 A3 A2 A1 A0 Offset -OE=0              -WE=0           Notes
;   1   0    X    0  0  0  0   0    Even RD Data       Even WR Data     1, 2
;   1   0    X    0  0  0  1   1    Error              Features         1, 2
;   1   0    X    0  0  1  0   2    Sector Count       Sector Count
;   1   0    X    0  0  1  1   3    Sector No.         Sector No.
;   1   0    X    0  1  0  0   4    Cylinder Low       Cylinder Low
;   1   0    X    0  1  0  1   5    Cylinder High      Cylinder High
;   1   0    X    0  1  1  0   6    Select Card/Head   Select Card/Head
;   1   0    X    0  1  1  1   7    Status             Command
;   1   0    X    1  0  0  0   8    Dup. Even RD Data  Dup. Even WR Data   2
;   1   0    X    1  0  0  1   9    Dup. Odd RD Data   Dup. Odd WR Data    2
;   1   0    X    1  1  0  1   D    Dup. Error Dup.    Features            2
;   1   0    X    1  1  1  0   E    Alt Status         Device Ctl
;   1   0    X    1  1  1  1   F    Drive Address      Reserved
;   1   1    X    X  X  X  0   8    Even RD Data       Even WR Data        3
;   1   1    X    X  X  X  1   9    Odd RD Data        Odd WR Data         3

;Note: 1) Register 0 is accessed with -CE1 low and -CE2 low as a word register
;on the combined Odd Data Bus and Even Data Bus (D15-D0). This register may
;also be accessed by a pair of byte accesses to the offset 0 with -CE1 low and
;-CE2 high. Note that the address space of this word register overlaps
;the address space of the Error and Feature byte-wide registers that lie at
;offset 1. When accessed twice as byte register with -CE1 low, the first byte
;to be accessed is the even byte of the word and the second byte accessed
;is the odd byte of the equivalent word access.
;A byte access to address 0 with -CE1 high and -CE2 low accesses the error
;(read) or feature (write) register.

;2) Registers at offset 8, 9 and D are non-overlapping duplicates of the
;registers at offset 0 and 1. Register 8 is equivalent to register 0,
;while register 9 accesses the odd byte. Therefore, if the registers are byte
;accessed in the order 9 then 8 the data will be transferred odd byte then even
;byte. Repeated byte accesses to register 8 or 0 will access consecutive
;(even then odd) bytes from the data buffer. Repeated word accesses to register
;8, 9 or 0 will access consecutive words from the data buffer. Repeated byte
;accesses to register 9 are not supported. However, repeated alternating byte
;accesses to registers 8 then 9 will access consecutive (even then odd) bytes
;from the data buffer. Byte accesses to register 9 access only the odd byte of
;the data.

;3) Accesses to even addresses between 400h and 7FFh access register 8.
;Accesses to odd addresses between 400h and 7FFh access register 9. This
;1 Kbyte memory window to the data register is provided so that hosts can
;perform memory to memory block moves to the data register when the register
;lies in memory space.
;

;
;CF register addresses
;
.equ CF_EvenData = ADR_CFC+0x08 ;Dupl. DAta
.equ CF_OddData = ADR_CFC+0x09 ;Dupl. Data
.equ CF_Error = ADR_CFC+0x0D ;Dupl. Errors / Features
.equ CF_SECCOUNT = ADR_CFC+0x02 ;Sectorcount
.equ CF_LBA0  = ADR_CFC+0x03 ;LBA 0-7
.equ CF_LBA1  = ADR_CFC+0x04 ;LBA 8-15
.equ CF_LBA2  = ADR_CFC+0x05 ;LBA 16-23
.equ CF_LBA3  = ADR_CFC+0x06 ;LBA 24-27
.equ CF_STACOM = ADR_CFC+0x07 ;Status / Command
.equ CF_DecCont = ADR_CFC+0x0E ;

 

;Class 1
;Upon receipt of a Class 1 command, the CompactFlash Storage Card sets BSY
;within 400 nsec.


;Class 2
;Upon receipt of a Class 2 command, the CompactFlash Storage Card sets BSY
;within 400 nsec, sets up the sector buffer for a write operation, sets DRQ
;within 700 usec, and clears BSY within 400 nsec of setting DRQ.

;Class 3
;Upon receipt of a Class 3 command, the CompactFlash Storage Card sets BSY
;within 400 nsec, sets up the sector buffer for a write operation, sets DRQ
;within 20 msec (assuming no re-assignments), and clears BSY within 400 nsec
;of setting DRQ.


;Table 37: CF-ATA Command Set
;
;Class COMMAND Code FR SC SN CY DH LBA
;1 Check Power Mode E5h or 98h - - - - D -
;1 Execute Drive Diagnostic 90h - - - - D -
;1 Erase Sector(s) C0h - Y Y Y Y Y
;1 Flush Cache E7h - - - - D -
;2 Format Track 50h - Y - Y Y Y
;1 Identify Drive ECh - - - - D -
;1 Idle E3h or 97h - Y - - D -
;1 Idle Immediate E1h or 95h - - - - D -
;1 Initialize Drive Parameters 91h - Y - - Y -
;1 Key Management Structure Read B9 Feature 0-127 C C C C D C -
;1 Key Management Read Keying Material B9 Feature 80 C C C C D C -
;2 Key Management Change Key Management Value B9 Feature 81 C C C C D C -
;1 NOP 00h - - - - D -
;1 Read Buffer E4h - - - - D -
;1 Read Long Sector 22h or 23h - - Y Y Y Y
;1 Read Multiple C4h - Y Y Y Y Y
;1 Read Sector(s) 20h or 21h - Y Y Y Y Y
;1 Read Verify Sector(s) 40h or 41h - Y Y Y Y Y
;1 Recalibrate 1Xh - - - - D -
;1 Request Sense 03h - - - - D -
;1 Security Disable Password F6h - - - - D -
;1 Security Erase Prepare F3h - - - - D -
;1 Security Erase Unit F4h - - - - D -
;1 Security Freeze Lock F5h - - - - D -
;1 Security Set Password F1h - - - - D -
;1 Security Unlock F2h - - - - D -
;1 Seek 7Xh - - Y Y Y Y
;1 Set Features EFh Y - - - D -
;1 Set Multiple Mode C6h - Y - - D -
;1 Set Sleep Mode E6h or 99h - - - - D -
;1 Standby E2h or 96h - - - - D -
;1 Standby Immediate E0h or 94h - - - - D -
;1 Translate Sector 87h - Y Y Y Y Y
;1 Wear Level F5h - - - - Y -
;2 Write Buffer E8h - - - - D -
;2 Write Long Sector 32h or 33h - - Y Y Y Y
;3 Write Multiple C5h - Y Y Y Y Y
;3 Write Multiple w/o Erase CDh - Y Y Y Y Y
;2 Write Sector(s) 30h or 31h - Y Y Y Y Y
;2 Write Sector(s) w/o Erase 38h - Y Y Y Y Y
;3 Write Verify 3Ch - Y Y Y Y Y
;
;Definitions:
;FR = Features Register
;SC = Sector Count Register
;SN = Sector Number Register
;CY = Cylinder Registers
;DH = Card/Drive/Head Register
;LBA = Logical Block Address Mode Supported (see command descriptions for use).
;Y - The register contains a valid parameter for this command. For the Drive/Head Register Y
;means both the CompactFlash Storage Card and head parameters are used; D - only the
;CompactFlash Storage Card parameter is valid and not the head parameter; C - The register
;contains command specific data (see command descriptions for use).
;

;CF-ATA Command Set
.equ CF_CMD_READ_SEC  = 0x20
.equ CF_CMD_WRITE_SEC = 0x30
.equ CF_CMD_IDENTIFY  = 0xEC

 

.equ CFRDY = 2  ;bit 2 = 1 CF ready
.equ CFVS1 = 3  ;bit 3 = 0 CF in slot

 

;***************************************************************************************
;*** Definition of the status register bits
;***
;*** Bit7               Bit0
;*** BSY  DRDY  DWF  DSC  DRQ  CORR  IDX  ERR
;***************************************************************************************
.equ CFC_STATUS_BSY = 0x80  ;Busy flag
.equ CFC_STATUS_DRDY = 0x40  ;Drive ready
.equ CFC_STATUS_DWF = 0x20  ;Drive write fault
.equ CFC_STATUS_DSC = 0x10  ;Drive seek complete
.equ CFC_STATUS_DRQ = 0x08  ;Data request
.equ CFC_STATUS_CORR = 0x04  ;Corrected data
.equ CFC_STATUS_IDX = 0x02  ;Index
.equ CFC_STATUS_ERR = 0x01  ;Error

 

;
;***************************************************************************
;**** VARIABLES
.DSEG

;***************************************************************************
.ESEG


;***************************************************************************
;**** CODE SEG
;***************************************************************************
.CSEG

 

;********************************************************
;CFRdy
;
; Wait until CF not busy
;
; Out: c= 0 no error
;   1 error
;
; Alt: R16,R17
;
CFHWRdy:
  lds R16,ADR_CFST
  bst R16,CFVS1  ;CF inserted?
  brtc CFHWRdy0
  rjmp CFDrvError
CFHWRdy0:
  lds R16,ADR_CFST
  bst R16,CFRDY  ;CF ready?
  brtc CFHWRdy
  clc
  ret

;********************************************************
;CFWaitDRQ
;
; Wait until Data will available
;
; Out: c= 0 no error
;   1 error
;
; Alt: R16,R17
;
CFWaitDRQ:
  rcall CFHWRdy
  brcc CFWaitDRQ00
  ret
CFWaitDRQ00:
  lds R16,CF_STACOM
  bst R16,0
  brtc CFWaitDRQ0
CFWaitErr:
  ldi R16,low(0xFFF0)  ;Error in last command
  ldi R17,high(0xFFF0) ;ide keresunk egy error kodot!!!
  sec
  ret

CFWaitDRQ0:
  andi R16,0xF8
  cpi R16,0x58
  brne CFWaitDRQ
  clc
  ret


;********************************************************
;CFWaitReady
;
; Wait until CF will ready
;
; Out: c= 0 no error
;   1 error
;
; Alt: R16,R17
;
CFWaitReady:
  rcall CFHWRdy
  brcc CFWaitRdy0
  ret
CFWaitRdy0:
  lds R16,CF_STACOM
  bst R16,0
  brts CFWaitErr
CFWaitReady01:
  andi R16,0xF0
  cpi R16,0x50
  brne CFWaitReady
  clc
  ret

;********************************************************
;CFReadSector
;
; In: R13:R12:R11:R10 - LBA sector number
;     Page: Y - Pointer to Data Buffer  [512 byte]
;     Z - Phis. Drive Descriptor
;
; Out: c= 0 no error
;   1 error
;
CFReadSector:
  ldd R0,Z+MaxSector+0
  ldd R1,Z+MaxSector+1
  ldd R2,Z+MaxSector+2
  ldd R3,Z+MaxSector+3
  cp R10,R0
  cpc R11,R1
  cpc R12,R2
  cpc R13,R3
  brcs CFReadSec00

  ldi R16,low(ERROR_SECTOR_NOT_FOUND) ;Sector number too big
  ldi R17,high(ERROR_SECTOR_NOT_FOUND)
  sec
  ret
CFReadSec00:
  std Z+CurrentSector+0,R10
  std Z+CurrentSector+1,R11
  std Z+CurrentSector+2,R12
  std Z+CurrentSector+3,R13

  rcall CFWaitReady
  brcc CFReadSec01
  ret    ;Error in last command
CFReadSec01:
  ldi R16,1
  sts CF_SECCOUNT,R16
  nop
  sts CF_LBA0,R10  ;D7..D0
  nop
  sts CF_LBA1,R11  ;D15..D8
  nop
  sts CF_LBA2,R12  ;D23..D16
  ldi R16,0x0F
  and R16,R13
  ori R16,0xE0  ;set LBA mode
  sts CF_LBA3,R16  ;D27..D24 + LBA mode + Drive0

  ldi R16,CF_CMD_READ_SEC
  sts CF_STACOM,R16  ;Set Read Sector Command

  ldi XL,0
  ldi XH,1   ;if X==0 -> X=256 word;

  movw R0,YL   ;save Y reg.

  rcall CFWaitDrq
  brcc CFReadSec02
  ret    ;Drive error
CFReadSec02:
  lds R16,ADR_CFST
  bst R16,CFVS1  ;CF inserted?
  brts CFDrvError
  bst R16,CFRDY  ;CF ready?
  brtc CFReadSec02

  lds R16,CF_EvenData
  st Y+,R16
  lds R16,CF_OddData
  st Y+,R16
  sbiw XL,1
  brne CFReadSec02

  movw YL,R0   ;restore Y reg.
  clc
  ret

CFDrvError:
  ldi R16,low(ERROR_BAD_UNIT)
  ldi R17,high(ERROR_BAD_UNIT) ;Drive not present
  sec
  ret

;********************************************************
;CFWriteSector
;
; In: R13:R12:R11:R10 - LBA sector number
;     Page: Y - Pointer to Data Buffer  [512 byte]
;     Z - Phis. Drive Descriptor
;
; Out: c= 0 no error
;   1 error
;
CFWriteSector:
  ldd R0,Z+MaxSector+0
  ldd R1,Z+MaxSector+1
  ldd R2,Z+MaxSector+2
  ldd R3,Z+MaxSector+3
  cp R10,R0
  cpc R11,R1
  cpc R12,R2
  cpc R13,R3
  brcs CFWriteSec00

  ldi R16,low(ERROR_SECTOR_NOT_FOUND) ;Sector number too big
  ldi R17,high(ERROR_SECTOR_NOT_FOUND)
  sec
  ret
CFWriteSec00:
  rcall CFWaitReady
  brcc CFWriteSec01
  ret    ;Error in last command
CFWriteSec01:
  ldi R16,1
  sts CF_SECCOUNT,R16
  nop
  sts CF_LBA0,R10  ;D7..D0
  nop
  sts CF_LBA1,R11  ;D15..D8
  nop
  sts CF_LBA2,R12  ;D23..D16
  ldi R16,0x0F
  and R16,R13
  ori R16,0xE0  ;set LBA mode
  sts CF_LBA3,R16  ;D27..D24 + LBA mode + Drive0
  ldi R16,CF_CMD_WRITE_SEC
  sts CF_STACOM,R16  ;Write sector command

  ldi XL,0
  ldi XH,1   ;if X==0 -> X=256 word;

  movw R0,YL

  rcall CFWaitDrq
  brcc CFWriteSec02
  ret    ;Drive error
CFWriteSec02:
  lds R16,ADR_CFST
  bst R16,CFVS1  ;CF inserted?
  brts CFDrvError
  bst R16,CFRDY  ;CF ready?
  brtc CFWriteSec02

  ld R16,Y+
  sts CF_EvenData,R16
  ld R16,Y+
  sts CF_OddData,R16
  sbiw XL,1     
  brne CFWriteSec02

  movw YL,R0
  clc
  ret

 

;********************************************************
;CFResetDevice
;
; In: -
;
; Out: c= 0 no error
;   1 error R17:R16 error code
;
CFResetDevice:
  ldi R16,0b00000100  ;Force SW reset
  sts ADR_CFC+0x0E,R16 ;Device Control Register
  ldi R16,64
CFRes0:  dec R17
  brne CFRes0
  dec R16
  brne CFRes0
  clr R16
  sts ADR_CFC+0x0E,R16 ;Device Control Register
  rcall CFWaitReady
  ret

 

;********************************************************
;CFIdentify
;
; In: Z - Phis. Drive Descriptor
;     Page: Y - Pointer to temporary Data Buffer [512 byte]
;
; Out: c= 0 no error
;   1 error
;
CFIdentify:
  rcall CFWaitReady
  brcc CFIdent01
  ret    ;Error code in R17:R16
CFIdent01:
  ldi R16,1
  sts CF_SECCOUNT,R16
  clr R16
  sts CF_LBA0,R16
  nop
  sts CF_LBA1,R16
  nop
  sts CF_LBA2,R16
  ldi R16,0xE0
  sts CF_LBA3,R16
  ldi R16,CF_CMD_IDENTIFY
  sts CF_STACOM,R16

  ldi XL,0   ;read fixed 256 word
  ldi XH,1
  movw R0,YL

  call CFWaitDRQ
  brcc CFIdent02
  ret    ;Drive error
CFIdent02:
  lds R16,CF_EvenData
  st Y+,R16
  nop
  lds R16,CF_OddData
  st Y+,R16
  sbiw XL,1
  brne CFIdent02
 
  movw YL,R0

  clr R0
  ldd R16,Y+0   ;CF IDs: 848Ah
  cpi R16,0x8A
  brne CFIDs0
  ldd R16,Y+1
  cpi R16,0x84
  brne  CFIDs0
  inc R0
CFIDs0:
  std Z+MediaFlag,R0  ;Store CF ID

  ldi R16,RemovableMedia
          std Z+MediaType,R16

  ldi R16,0x80
  std Z+DiskNumber,R16 ;First HDD => HDD0

 
  ldd R16,Y+2   ;Default tracks/cylinders
  ldd R17,Y+3
   std Z+Cylinders+0,R16
   std Z+Cylinders+1,R17

                ldd R16,Y+6   ;Default Heads
  std Z+Heads,R16

         ldd R16,Y+12  ;default Sectors per track
  std Z+SectorsPerTrack,R16

  ldd R16,Y+14  ;Number of Sectors per Card
  std Z+MaxSector+2,R16 ;MSW -LSW !!!
  ldd R16,Y+15
  std Z+MaxSector+3,R16
  ldd R16,Y+16
  std Z+MaxSector+0,R16
  ldd R16,Y+17
  std Z+MaxSector+1,R16

  clc
  ret


[admin via 研發互助社區 ] AVR與CF卡(IDE)介面已經有4519次圍觀

http://cocdig.com/docs/show-post-42803.html