Moved CMSIS and other LPC1768 dependencies
Fixes Arduino IDE builds for 8-bit AVR, misc: Adafruit NeoPixel currently incompatible with Teensy 3.5-6, blacklisted
This commit is contained in:
parent
b55295ad33
commit
4183a249b6
98 changed files with 18 additions and 30240 deletions
|
@ -1,1143 +0,0 @@
|
|||
/*-------------------------------------------------------------------*/
|
||||
/* LPC176x Register Definitions and Cortex-M3 Supplement Definitions */
|
||||
/* This file is a non-copyrighted public domain software */
|
||||
/*-------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __LPC176x
|
||||
#define __LPC176x
|
||||
#include <stdint.h>
|
||||
|
||||
#define USE_SV_SERVICE 0 /* Enable supervisor service for user mode task */
|
||||
|
||||
|
||||
/* System Controls */
|
||||
#define EXTINT (*(volatile uint32_t*)0x400FC140)
|
||||
#define EXTMODE (*(volatile uint32_t*)0x400FC148)
|
||||
#define EXTPOLAR (*(volatile uint32_t*)0x400FC14C)
|
||||
#define RSID (*(volatile uint32_t*)0x400FC180)
|
||||
#define SCS (*(volatile uint32_t*)0x400FC1A0)
|
||||
|
||||
/* Clocking and Power Controls */
|
||||
#define CLKSRCSEL (*(volatile uint32_t*)0x400FC10C)
|
||||
#define PLL0CON (*(volatile uint32_t*)0x400FC080)
|
||||
#define PLL0CFG (*(volatile uint32_t*)0x400FC084)
|
||||
#define PLL0STAT (*(volatile uint32_t*)0x400FC088)
|
||||
#define PLL0FEED (*(volatile uint32_t*)0x400FC08C)
|
||||
#define PLL1CON (*(volatile uint32_t*)0x400FC0A0)
|
||||
#define PLL1CFG (*(volatile uint32_t*)0x400FC0A4)
|
||||
#define PLL1STAT (*(volatile uint32_t*)0x400FC0A8)
|
||||
#define PLL1FEED (*(volatile uint32_t*)0x400FC0AC)
|
||||
#define CCLKCFG (*(volatile uint32_t*)0x400FC104)
|
||||
#define USBCLKCFG (*(volatile uint32_t*)0x400FC108)
|
||||
#define PCLKSEL ( (volatile uint32_t*)0x400FC1A8)
|
||||
#define PCLKSEL0 (*(volatile uint32_t*)0x400FC1A8)
|
||||
#define PCLKSEL1 (*(volatile uint32_t*)0x400FC1AC)
|
||||
#define PCON (*(volatile uint32_t*)0x400FC0C0)
|
||||
#define PCONP (*(volatile uint32_t*)0x400FC0C4)
|
||||
#define CLKOUTCFG (*(volatile uint32_t*)0x400FC1C8)
|
||||
|
||||
/* Flash Accelerator */
|
||||
#define FLASHCFG (*(volatile uint32_t*)0x400FC000)
|
||||
|
||||
/* Pin Configurations */
|
||||
#define PINSEL ( (volatile uint32_t*)0x4002C000)
|
||||
#define PINSEL0 (*(volatile uint32_t*)0x4002C000)
|
||||
#define PINSEL1 (*(volatile uint32_t*)0x4002C004)
|
||||
#define PINSEL2 (*(volatile uint32_t*)0x4002C008)
|
||||
#define PINSEL3 (*(volatile uint32_t*)0x4002C00C)
|
||||
#define PINSEL4 (*(volatile uint32_t*)0x4002C010)
|
||||
#define PINSEL7 (*(volatile uint32_t*)0x4002C01C)
|
||||
#define PINSEL8 (*(volatile uint32_t*)0x4002C020)
|
||||
#define PINSEL9 (*(volatile uint32_t*)0x4002C024)
|
||||
#define PINSEL10 (*(volatile uint32_t*)0x4002C028)
|
||||
#define PINMODE ( (volatile uint32_t*)0x4002C040)
|
||||
#define PINMODE0 (*(volatile uint32_t*)0x4002C040)
|
||||
#define PINMODE1 (*(volatile uint32_t*)0x4002C044)
|
||||
#define PINMODE2 (*(volatile uint32_t*)0x4002C048)
|
||||
#define PINMODE3 (*(volatile uint32_t*)0x4002C04C)
|
||||
#define PINMODE4 (*(volatile uint32_t*)0x4002C050)
|
||||
#define PINMODE5 (*(volatile uint32_t*)0x4002C054)
|
||||
#define PINMODE6 (*(volatile uint32_t*)0x4002C058)
|
||||
#define PINMODE7 (*(volatile uint32_t*)0x4002C05C)
|
||||
#define PINMODE9 (*(volatile uint32_t*)0x4002C064)
|
||||
#define PINMODE_OD ( (volatile uint32_t*)0x4002C068)
|
||||
#define PINMODE_OD0 (*(volatile uint32_t*)0x4002C068)
|
||||
#define PINMODE_OD1 (*(volatile uint32_t*)0x4002C06C)
|
||||
#define PINMODE_OD2 (*(volatile uint32_t*)0x4002C070)
|
||||
#define PINMODE_OD3 (*(volatile uint32_t*)0x4002C074)
|
||||
#define PINMODE_OD4 (*(volatile uint32_t*)0x4002C078)
|
||||
#define I2CPADCFG (*(volatile uint32_t*)0x4002C07C)
|
||||
|
||||
/* GPIO */
|
||||
#define FIO0DIR (*(volatile uint32_t*)0x2009C000)
|
||||
#define FIO0DIRL (*(volatile uint16_t*)0x2009C000)
|
||||
#define FIO0DIRH (*(volatile uint16_t*)0x2009C002)
|
||||
#define FIO0DIR0 (*(volatile uint8_t*)0x2009C000)
|
||||
#define FIO0DIR1 (*(volatile uint8_t*)0x2009C001)
|
||||
#define FIO0DIR2 (*(volatile uint8_t*)0x2009C002)
|
||||
#define FIO0DIR3 (*(volatile uint8_t*)0x2009C003)
|
||||
|
||||
#define FIO1DIR (*(volatile uint32_t*)0x2009C020)
|
||||
#define FIO1DIRL (*(volatile uint16_t*)0x2009C020)
|
||||
#define FIO1DIRH (*(volatile uint16_t*)0x2009C022)
|
||||
#define FIO1DIR0 (*(volatile uint8_t*)0x2009C020)
|
||||
#define FIO1DIR1 (*(volatile uint8_t*)0x2009C021)
|
||||
#define FIO1DIR2 (*(volatile uint8_t*)0x2009C022)
|
||||
#define FIO1DIR3 (*(volatile uint8_t*)0x2009C023)
|
||||
|
||||
#define FIO2DIR (*(volatile uint32_t*)0x2009C040)
|
||||
#define FIO2DIRL (*(volatile uint16_t*)0x2009C040)
|
||||
#define FIO2DIRH (*(volatile uint16_t*)0x2009C042)
|
||||
#define FIO2DIR0 (*(volatile uint8_t*)0x2009C040)
|
||||
#define FIO2DIR1 (*(volatile uint8_t*)0x2009C041)
|
||||
#define FIO2DIR2 (*(volatile uint8_t*)0x2009C042)
|
||||
#define FIO2DIR3 (*(volatile uint8_t*)0x2009C043)
|
||||
|
||||
#define FIO3DIR (*(volatile uint32_t*)0x2009C060)
|
||||
#define FIO3DIRL (*(volatile uint16_t*)0x2009C060)
|
||||
#define FIO3DIRH (*(volatile uint16_t*)0x2009C062)
|
||||
#define FIO3DIR0 (*(volatile uint8_t*)0x2009C060)
|
||||
#define FIO3DIR1 (*(volatile uint8_t*)0x2009C061)
|
||||
#define FIO3DIR2 (*(volatile uint8_t*)0x2009C062)
|
||||
#define FIO3DIR3 (*(volatile uint8_t*)0x2009C063)
|
||||
|
||||
#define FIO4DIR (*(volatile uint32_t*)0x2009C080)
|
||||
#define FIO4DIRL (*(volatile uint16_t*)0x2009C080)
|
||||
#define FIO4DIRH (*(volatile uint16_t*)0x2009C082)
|
||||
#define FIO4DIR0 (*(volatile uint8_t*)0x2009C080)
|
||||
#define FIO4DIR1 (*(volatile uint8_t*)0x2009C081)
|
||||
#define FIO4DIR2 (*(volatile uint8_t*)0x2009C082)
|
||||
#define FIO4DIR3 (*(volatile uint8_t*)0x2009C083)
|
||||
|
||||
#define FIO0MASK (*(volatile uint32_t*)0x2009C010)
|
||||
#define FIO0MASKL (*(volatile uint16_t*)0x2009C010)
|
||||
#define FIO0MASKH (*(volatile uint16_t*)0x2009C012)
|
||||
#define FIO0MASK0 (*(volatile uint8_t*)0x2009C010)
|
||||
#define FIO0MASK1 (*(volatile uint8_t*)0x2009C011)
|
||||
#define FIO0MASK2 (*(volatile uint8_t*)0x2009C012)
|
||||
#define FIO0MASK3 (*(volatile uint8_t*)0x2009C013)
|
||||
|
||||
#define FIO1MASK (*(volatile uint32_t*)0x2009C030)
|
||||
#define FIO1MASKL (*(volatile uint16_t*)0x2009C030)
|
||||
#define FIO1MASKH (*(volatile uint16_t*)0x2009C032)
|
||||
#define FIO1MASK0 (*(volatile uint8_t*)0x2009C030)
|
||||
#define FIO1MASK1 (*(volatile uint8_t*)0x2009C031)
|
||||
#define FIO1MASK2 (*(volatile uint8_t*)0x2009C032)
|
||||
#define FIO1MASK3 (*(volatile uint8_t*)0x2009C033)
|
||||
|
||||
#define FIO2MASK (*(volatile uint32_t*)0x2009C050)
|
||||
#define FIO2MASKL (*(volatile uint16_t*)0x2009C050)
|
||||
#define FIO2MASKH (*(volatile uint16_t*)0x2009C052)
|
||||
#define FIO2MASK0 (*(volatile uint8_t*)0x2009C050)
|
||||
#define FIO2MASK1 (*(volatile uint8_t*)0x2009C051)
|
||||
#define FIO2MASK2 (*(volatile uint8_t*)0x2009C052)
|
||||
#define FIO2MASK3 (*(volatile uint8_t*)0x2009C053)
|
||||
|
||||
#define FIO3MASK (*(volatile uint32_t*)0x2009C070)
|
||||
#define FIO3MASKL (*(volatile uint16_t*)0x2009C070)
|
||||
#define FIO3MASKH (*(volatile uint16_t*)0x2009C072)
|
||||
#define FIO3MASK0 (*(volatile uint8_t*)0x2009C070)
|
||||
#define FIO3MASK1 (*(volatile uint8_t*)0x2009C071)
|
||||
#define FIO3MASK2 (*(volatile uint8_t*)0x2009C072)
|
||||
#define FIO3MASK3 (*(volatile uint8_t*)0x2009C073)
|
||||
|
||||
#define FIO4MASK (*(volatile uint32_t*)0x2009C090)
|
||||
#define FIO4MASKL (*(volatile uint16_t*)0x2009C090)
|
||||
#define FIO4MASKH (*(volatile uint16_t*)0x2009C092)
|
||||
#define FIO4MASK0 (*(volatile uint8_t*)0x2009C090)
|
||||
#define FIO4MASK1 (*(volatile uint8_t*)0x2009C091)
|
||||
#define FIO4MASK2 (*(volatile uint8_t*)0x2009C092)
|
||||
#define FIO4MASK3 (*(volatile uint8_t*)0x2009C093)
|
||||
|
||||
#define FIO0PIN (*(volatile uint32_t*)0x2009C014)
|
||||
#define FIO0PINL (*(volatile uint16_t*)0x2009C014)
|
||||
#define FIO0PINH (*(volatile uint16_t*)0x2009C016)
|
||||
#define FIO0PIN0 (*(volatile uint8_t*)0x2009C014)
|
||||
#define FIO0PIN1 (*(volatile uint8_t*)0x2009C015)
|
||||
#define FIO0PIN2 (*(volatile uint8_t*)0x2009C016)
|
||||
#define FIO0PIN3 (*(volatile uint8_t*)0x2009C017)
|
||||
|
||||
#define FIO1PIN (*(volatile uint32_t*)0x2009C034)
|
||||
#define FIO1PINL (*(volatile uint16_t*)0x2009C034)
|
||||
#define FIO1PINH (*(volatile uint16_t*)0x2009C036)
|
||||
#define FIO1PIN0 (*(volatile uint8_t*)0x2009C034)
|
||||
#define FIO1PIN1 (*(volatile uint8_t*)0x2009C035)
|
||||
#define FIO1PIN2 (*(volatile uint8_t*)0x2009C036)
|
||||
#define FIO1PIN3 (*(volatile uint8_t*)0x2009C037)
|
||||
|
||||
#define FIO2PIN (*(volatile uint32_t*)0x2009C054)
|
||||
#define FIO2PINL (*(volatile uint16_t*)0x2009C054)
|
||||
#define FIO2PINH (*(volatile uint16_t*)0x2009C056)
|
||||
#define FIO2PIN0 (*(volatile uint8_t*)0x2009C054)
|
||||
#define FIO2PIN1 (*(volatile uint8_t*)0x2009C055)
|
||||
#define FIO2PIN2 (*(volatile uint8_t*)0x2009C056)
|
||||
#define FIO2PIN3 (*(volatile uint8_t*)0x2009C057)
|
||||
|
||||
#define FIO3PIN (*(volatile uint32_t*)0x2009C074)
|
||||
#define FIO3PINL (*(volatile uint16_t*)0x2009C074)
|
||||
#define FIO3PINH (*(volatile uint16_t*)0x2009C076)
|
||||
#define FIO3PIN0 (*(volatile uint8_t*)0x2009C074)
|
||||
#define FIO3PIN1 (*(volatile uint8_t*)0x2009C075)
|
||||
#define FIO3PIN2 (*(volatile uint8_t*)0x2009C076)
|
||||
#define FIO3PIN3 (*(volatile uint8_t*)0x2009C077)
|
||||
|
||||
#define FIO4PIN (*(volatile uint32_t*)0x2009C094)
|
||||
#define FIO4PINL (*(volatile uint16_t*)0x2009C094)
|
||||
#define FIO4PINH (*(volatile uint16_t*)0x2009C096)
|
||||
#define FIO4PIN0 (*(volatile uint8_t*)0x2009C094)
|
||||
#define FIO4PIN1 (*(volatile uint8_t*)0x2009C095)
|
||||
#define FIO4PIN2 (*(volatile uint8_t*)0x2009C096)
|
||||
#define FIO4PIN3 (*(volatile uint8_t*)0x2009C097)
|
||||
|
||||
#define FIO0SET (*(volatile uint32_t*)0x2009C018)
|
||||
#define FIO0SETL (*(volatile uint16_t*)0x2009C018)
|
||||
#define FIO0SETH (*(volatile uint16_t*)0x2009C01A)
|
||||
#define FIO0SET0 (*(volatile uint8_t*)0x2009C018)
|
||||
#define FIO0SET1 (*(volatile uint8_t*)0x2009C019)
|
||||
#define FIO0SET2 (*(volatile uint8_t*)0x2009C01A)
|
||||
#define FIO0SET3 (*(volatile uint8_t*)0x2009C01B)
|
||||
|
||||
#define FIO1SET (*(volatile uint32_t*)0x2009C038)
|
||||
#define FIO1SETL (*(volatile uint16_t*)0x2009C038)
|
||||
#define FIO1SETH (*(volatile uint16_t*)0x2009C03A)
|
||||
#define FIO1SET0 (*(volatile uint8_t*)0x2009C038)
|
||||
#define FIO1SET1 (*(volatile uint8_t*)0x2009C039)
|
||||
#define FIO1SET2 (*(volatile uint8_t*)0x2009C03A)
|
||||
#define FIO1SET3 (*(volatile uint8_t*)0x2009C03B)
|
||||
|
||||
#define FIO2SET (*(volatile uint32_t*)0x2009C058)
|
||||
#define FIO2SETL (*(volatile uint16_t*)0x2009C058)
|
||||
#define FIO2SETH (*(volatile uint16_t*)0x2009C05A)
|
||||
#define FIO2SET0 (*(volatile uint8_t*)0x2009C058)
|
||||
#define FIO2SET1 (*(volatile uint8_t*)0x2009C059)
|
||||
#define FIO2SET2 (*(volatile uint8_t*)0x2009C05A)
|
||||
#define FIO2SET3 (*(volatile uint8_t*)0x2009C05B)
|
||||
|
||||
#define FIO3SET (*(volatile uint32_t*)0x2009C078)
|
||||
#define FIO3SETL (*(volatile uint16_t*)0x2009C078)
|
||||
#define FIO3SETH (*(volatile uint16_t*)0x2009C07A)
|
||||
#define FIO3SET0 (*(volatile uint8_t*)0x2009C078)
|
||||
#define FIO3SET1 (*(volatile uint8_t*)0x2009C079)
|
||||
#define FIO3SET2 (*(volatile uint8_t*)0x2009C07A)
|
||||
#define FIO3SET3 (*(volatile uint8_t*)0x2009C07B)
|
||||
|
||||
#define FIO4SET (*(volatile uint32_t*)0x2009C098)
|
||||
#define FIO4SETL (*(volatile uint16_t*)0x2009C098)
|
||||
#define FIO4SETH (*(volatile uint16_t*)0x2009C09A)
|
||||
#define FIO4SET0 (*(volatile uint8_t*)0x2009C098)
|
||||
#define FIO4SET1 (*(volatile uint8_t*)0x2009C099)
|
||||
#define FIO4SET2 (*(volatile uint8_t*)0x2009C09A)
|
||||
#define FIO4SET3 (*(volatile uint8_t*)0x2009C09B)
|
||||
|
||||
#define FIO0CLR (*(volatile uint32_t*)0x2009C01C)
|
||||
#define FIO0CLRL (*(volatile uint16_t*)0x2009C01C)
|
||||
#define FIO0CLRH (*(volatile uint16_t*)0x2009C01E)
|
||||
#define FIO0CLR0 (*(volatile uint8_t*)0x2009C01C)
|
||||
#define FIO0CLR1 (*(volatile uint8_t*)0x2009C01D)
|
||||
#define FIO0CLR2 (*(volatile uint8_t*)0x2009C01E)
|
||||
#define FIO0CLR3 (*(volatile uint8_t*)0x2009C01F)
|
||||
|
||||
#define FIO1CLR (*(volatile uint32_t*)0x2009C03C)
|
||||
#define FIO1CLRL (*(volatile uint16_t*)0x2009C03C)
|
||||
#define FIO1CLRH (*(volatile uint16_t*)0x2009C03E)
|
||||
#define FIO1CLR0 (*(volatile uint8_t*)0x2009C03C)
|
||||
#define FIO1CLR1 (*(volatile uint8_t*)0x2009C03D)
|
||||
#define FIO1CLR2 (*(volatile uint8_t*)0x2009C03E)
|
||||
#define FIO1CLR3 (*(volatile uint8_t*)0x2009C03F)
|
||||
|
||||
#define FIO2CLR (*(volatile uint32_t*)0x2009C05C)
|
||||
#define FIO2CLRL (*(volatile uint16_t*)0x2009C05C)
|
||||
#define FIO2CLRH (*(volatile uint16_t*)0x2009C05E)
|
||||
#define FIO2CLR0 (*(volatile uint8_t*)0x2009C05C)
|
||||
#define FIO2CLR1 (*(volatile uint8_t*)0x2009C05D)
|
||||
#define FIO2CLR2 (*(volatile uint8_t*)0x2009C05E)
|
||||
#define FIO2CLR3 (*(volatile uint8_t*)0x2009C05F)
|
||||
|
||||
#define FIO3CLR (*(volatile uint32_t*)0x2009C07C)
|
||||
#define FIO3CLRL (*(volatile uint16_t*)0x2009C07C)
|
||||
#define FIO3CLRH (*(volatile uint16_t*)0x2009C07E)
|
||||
#define FIO3CLR0 (*(volatile uint8_t*)0x2009C07C)
|
||||
#define FIO3CLR1 (*(volatile uint8_t*)0x2009C07D)
|
||||
#define FIO3CLR2 (*(volatile uint8_t*)0x2009C07E)
|
||||
#define FIO3CLR3 (*(volatile uint8_t*)0x2009C07F)
|
||||
|
||||
#define FIO4CLR (*(volatile uint32_t*)0x2009C09C)
|
||||
#define FIO4CLRL (*(volatile uint16_t*)0x2009C09C)
|
||||
#define FIO4CLRH (*(volatile uint16_t*)0x2009C09E)
|
||||
#define FIO4CLR0 (*(volatile uint8_t*)0x2009C09C)
|
||||
#define FIO4CLR1 (*(volatile uint8_t*)0x2009C09D)
|
||||
#define FIO4CLR2 (*(volatile uint8_t*)0x2009C09E)
|
||||
#define FIO4CLR3 (*(volatile uint8_t*)0x2009C09F)
|
||||
|
||||
#define IOIntStatus (*(volatile uint32_t*)0x40028080)
|
||||
#define IO0IntStatR (*(volatile uint32_t*)0x40028084)
|
||||
#define IO0IntStatF (*(volatile uint32_t*)0x40028088)
|
||||
#define IO0IntClr (*(volatile uint32_t*)0x4002808C)
|
||||
#define IO0IntEnR (*(volatile uint32_t*)0x40028090)
|
||||
#define IO0IntEnF (*(volatile uint32_t*)0x40028094)
|
||||
#define IO2IntStatR (*(volatile uint32_t*)0x400280A4)
|
||||
#define IO2IntStatF (*(volatile uint32_t*)0x400280A8)
|
||||
#define IO2IntClr (*(volatile uint32_t*)0x400280AC)
|
||||
#define IO2IntEnR (*(volatile uint32_t*)0x400280B0)
|
||||
#define IO2IntEnF (*(volatile uint32_t*)0x400280B4)
|
||||
|
||||
/* Ethernet MAC */
|
||||
#define MAC1 (*(volatile uint32_t*)0x50000000)
|
||||
#define MAC2 (*(volatile uint32_t*)0x50000004)
|
||||
#define IPGT (*(volatile uint32_t*)0x50000008)
|
||||
#define IPGR (*(volatile uint32_t*)0x5000000C)
|
||||
#define CLRT (*(volatile uint32_t*)0x50000010)
|
||||
#define MAXF (*(volatile uint32_t*)0x50000014)
|
||||
#define SUPP (*(volatile uint32_t*)0x50000018)
|
||||
#define TEST (*(volatile uint32_t*)0x5000001C)
|
||||
#define MCFG (*(volatile uint32_t*)0x50000020)
|
||||
#define MCMD (*(volatile uint32_t*)0x50000024)
|
||||
#define MADR (*(volatile uint32_t*)0x50000028)
|
||||
#define MWTD (*(volatile uint32_t*)0x5000002C)
|
||||
#define MRDD (*(volatile uint32_t*)0x50000030)
|
||||
#define MIND (*(volatile uint32_t*)0x50000034)
|
||||
#define SA0 (*(volatile uint32_t*)0x50000040)
|
||||
#define SA1 (*(volatile uint32_t*)0x50000044)
|
||||
#define SA2 (*(volatile uint32_t*)0x50000048)
|
||||
#define Command (*(volatile uint32_t*)0x50000100)
|
||||
#define Status (*(volatile uint32_t*)0x50000104)
|
||||
#define RxDescriptor (*(volatile uint32_t*)0x50000108)
|
||||
#define RxStatus (*(volatile uint32_t*)0x5000010C)
|
||||
#define RxDescriptorNumber (*(volatile uint32_t*)0x50000110)
|
||||
#define RxProduceIndex (*(volatile uint32_t*)0x50000114)
|
||||
#define RxConsumeIndex (*(volatile uint32_t*)0x50000118)
|
||||
#define TxDescriptor (*(volatile uint32_t*)0x5000011C)
|
||||
#define TxStatus (*(volatile uint32_t*)0x50000120)
|
||||
#define TxDescriptorNumber (*(volatile uint32_t*)0x50000124)
|
||||
#define TxProduceIndex (*(volatile uint32_t*)0x50000128)
|
||||
#define TxConsumeIndex (*(volatile uint32_t*)0x5000012C)
|
||||
#define TSV0 (*(volatile uint32_t*)0x50000158)
|
||||
#define TSV1 (*(volatile uint32_t*)0x5000015C)
|
||||
#define RSV (*(volatile uint32_t*)0x50000160)
|
||||
#define FlowControlCounter (*(volatile uint32_t*)0x50000170)
|
||||
#define FlowControlStatus (*(volatile uint32_t*)0x50000174)
|
||||
#define RxFliterCtrl (*(volatile uint32_t*)0x50000200)
|
||||
#define RxFilterWoLStatus (*(volatile uint32_t*)0x50000204)
|
||||
#define RxFilterWoLClear (*(volatile uint32_t*)0x50000208)
|
||||
#define HashFilterL (*(volatile uint32_t*)0x50000210)
|
||||
#define HashFilterH (*(volatile uint32_t*)0x50000214)
|
||||
#define IntStatus (*(volatile uint32_t*)0x50000FE0)
|
||||
#define IntEnable (*(volatile uint32_t*)0x50000FE4)
|
||||
#define IntClear (*(volatile uint32_t*)0x50000FE8)
|
||||
#define IntSet (*(volatile uint32_t*)0x50000FEC)
|
||||
#define PowerDown (*(volatile uint32_t*)0x50000FF4)
|
||||
|
||||
/* USB Device */
|
||||
#define USBClkCtrl (*(volatile uint32_t*)0x5000CFF4)
|
||||
#define USBClkSt (*(volatile uint32_t*)0x5000CFF8)
|
||||
#define USBIntSt (*(volatile uint32_t*)0x400FC1C0)
|
||||
#define USBDevIntSt (*(volatile uint32_t*)0x5000C200)
|
||||
#define USBDevIntEn (*(volatile uint32_t*)0x5000C204)
|
||||
#define USBDevIntClr (*(volatile uint32_t*)0x5000C208)
|
||||
#define USBDevIntSet (*(volatile uint32_t*)0x5000C20C)
|
||||
#define USBDevIntPri (*(volatile uint32_t*)0x5000C22C)
|
||||
#define USBEpIntSt (*(volatile uint32_t*)0x5000C230)
|
||||
#define USBEpIntEn (*(volatile uint32_t*)0x5000C234)
|
||||
#define USBEpIntClr (*(volatile uint32_t*)0x5000C238)
|
||||
#define USBEpIntSet (*(volatile uint32_t*)0x5000C23C)
|
||||
#define USBEpIntPri (*(volatile uint32_t*)0x5000C240)
|
||||
#define USBReEp (*(volatile uint32_t*)0x5000C244)
|
||||
#define USBEpIn (*(volatile uint32_t*)0x5000C248)
|
||||
#define USBMaxPSize (*(volatile uint32_t*)0x5000C24C)
|
||||
#define USBRxData (*(volatile uint32_t*)0x5000C218)
|
||||
#define USBRxPLen (*(volatile uint32_t*)0x5000C220)
|
||||
#define USBTxData (*(volatile uint32_t*)0x5000C21C)
|
||||
#define USBTxPLen (*(volatile uint32_t*)0x5000C224)
|
||||
#define USBCtrl (*(volatile uint32_t*)0x5000C228)
|
||||
#define USBCmdCode (*(volatile uint32_t*)0x5000C210)
|
||||
#define USBCmdData (*(volatile uint32_t*)0x5000C214)
|
||||
#define USBDMARSt (*(volatile uint32_t*)0x5000C250)
|
||||
#define USBDMARClr (*(volatile uint32_t*)0x5000C254)
|
||||
#define USBDMARSet (*(volatile uint32_t*)0x5000C258)
|
||||
#define USBUDCAH (*(volatile uint32_t*)0x5000C280)
|
||||
#define USBEpDMASt (*(volatile uint32_t*)0x5000C284)
|
||||
#define USBEpDMAEn (*(volatile uint32_t*)0x5000C288)
|
||||
#define USBEpDMADis (*(volatile uint32_t*)0x5000C28C)
|
||||
#define USBDMAIntSt (*(volatile uint32_t*)0x5000C290)
|
||||
#define USBDMAIntEn (*(volatile uint32_t*)0x5000C294)
|
||||
#define USBEoTIntSt (*(volatile uint32_t*)0x5000C2A0)
|
||||
#define USBEoTIntClr (*(volatile uint32_t*)0x5000C2A4)
|
||||
#define USBEoTIntSet (*(volatile uint32_t*)0x5000C2A8)
|
||||
#define USBNDDRIntSt (*(volatile uint32_t*)0x5000C2AC)
|
||||
#define USBNDDRIntClr (*(volatile uint32_t*)0x5000C2B0)
|
||||
#define USBNDDRIntSet (*(volatile uint32_t*)0x5000C2B4)
|
||||
#define USBSysErrIntSt (*(volatile uint32_t*)0x5000C2B8)
|
||||
#define USBSysErrIntClr (*(volatile uint32_t*)0x5000C2BC)
|
||||
#define USBSysErrIntSet (*(volatile uint32_t*)0x5000C2C0)
|
||||
|
||||
/* USB OTG */
|
||||
#define USBIntSt (*(volatile uint32_t*)0x400FC1C0)
|
||||
#define OTGIntSt (*(volatile uint32_t*)0x5000C100)
|
||||
#define OTGIntEn (*(volatile uint32_t*)0x5000C104)
|
||||
#define OTGIntSet (*(volatile uint32_t*)0x5000C108)
|
||||
#define OTGIntClr (*(volatile uint32_t*)0x5000C10C)
|
||||
#define OTGStCtrl (*(volatile uint32_t*)0x5000C110)
|
||||
#define OTGTmr (*(volatile uint32_t*)0x5000C114)
|
||||
#define I2C_RX (*(volatile uint32_t*)0x5000C300)
|
||||
#define I2C_TX (*(volatile uint32_t*)0x5000C300)
|
||||
#define I2C_STS (*(volatile uint32_t*)0x5000C304)
|
||||
#define I2C_CTL (*(volatile uint32_t*)0x5000C308)
|
||||
#define I2C_CLKHI (*(volatile uint32_t*)0x5000C30C)
|
||||
#define I2C_CLKLO (*(volatile uint32_t*)0x5000C310)
|
||||
#define OTGClkCtrl (*(volatile uint32_t*)0x5000CFF4)
|
||||
#define OTGClkSt (*(volatile uint32_t*)0x5000CFF8)
|
||||
|
||||
/* UART0,UART1,UART2,UART3 */
|
||||
#define U0RBR (*(volatile uint32_t*)0x4000C000)
|
||||
#define U0THR (*(volatile uint32_t*)0x4000C000)
|
||||
#define U0DLL (*(volatile uint32_t*)0x4000C000)
|
||||
#define U0DLM (*(volatile uint32_t*)0x4000C004)
|
||||
#define U0IER (*(volatile uint32_t*)0x4000C004)
|
||||
#define U0IIR (*(volatile uint32_t*)0x4000C008)
|
||||
#define U0FCR (*(volatile uint32_t*)0x4000C008)
|
||||
#define U0LCR (*(volatile uint32_t*)0x4000C00C)
|
||||
#define U0LSR (*(volatile uint32_t*)0x4000C014)
|
||||
#define U0SCR (*(volatile uint32_t*)0x4000C01C)
|
||||
#define U0ACR (*(volatile uint32_t*)0x4000C020)
|
||||
#define U0ICR (*(volatile uint32_t*)0x4000C024)
|
||||
#define U0FDR (*(volatile uint32_t*)0x4000C028)
|
||||
#define U0TER (*(volatile uint32_t*)0x4000C030)
|
||||
|
||||
#define U1RBR (*(volatile uint32_t*)0x40010000)
|
||||
#define U1THR (*(volatile uint32_t*)0x40010000)
|
||||
#define U1DLL (*(volatile uint32_t*)0x40010000)
|
||||
#define U1DLM (*(volatile uint32_t*)0x40010004)
|
||||
#define U1IER (*(volatile uint32_t*)0x40010004)
|
||||
#define U1IIR (*(volatile uint32_t*)0x40010008)
|
||||
#define U1FCR (*(volatile uint32_t*)0x40010008)
|
||||
#define U1LCR (*(volatile uint32_t*)0x4001000C)
|
||||
#define U1MCR (*(volatile uint32_t*)0x40010010)
|
||||
#define U1LSR (*(volatile uint32_t*)0x40010014)
|
||||
#define U1MSR (*(volatile uint32_t*)0x40010018)
|
||||
#define U1SCR (*(volatile uint32_t*)0x4001001C)
|
||||
#define U1ACR (*(volatile uint32_t*)0x40010020)
|
||||
#define U1FDR (*(volatile uint32_t*)0x40010028)
|
||||
#define U1TER (*(volatile uint32_t*)0x40010030)
|
||||
#define U1RS485CTRL (*(volatile uint32_t*)0x4001004C)
|
||||
#define U1ADRMATCH (*(volatile uint32_t*)0x40010050)
|
||||
#define U1RS485DLY (*(volatile uint32_t*)0x40010054)
|
||||
|
||||
#define U2RBR (*(volatile uint32_t*)0x40098000)
|
||||
#define U2THR (*(volatile uint32_t*)0x40098000)
|
||||
#define U2DLL (*(volatile uint32_t*)0x40098000)
|
||||
#define U2DLM (*(volatile uint32_t*)0x40098004)
|
||||
#define U2IER (*(volatile uint32_t*)0x40098004)
|
||||
#define U2IIR (*(volatile uint32_t*)0x40098008)
|
||||
#define U2FCR (*(volatile uint32_t*)0x40098008)
|
||||
#define U2LCR (*(volatile uint32_t*)0x4009800C)
|
||||
#define U2LSR (*(volatile uint32_t*)0x40098014)
|
||||
#define U2SCR (*(volatile uint32_t*)0x4009801C)
|
||||
#define U2ACR (*(volatile uint32_t*)0x40098020)
|
||||
#define U2ICR (*(volatile uint32_t*)0x40098024)
|
||||
#define U2FDR (*(volatile uint32_t*)0x40098028)
|
||||
#define U2TER (*(volatile uint32_t*)0x40098030)
|
||||
|
||||
#define U3RBR (*(volatile uint32_t*)0x4009C000)
|
||||
#define U3THR (*(volatile uint32_t*)0x4009C000)
|
||||
#define U3DLL (*(volatile uint32_t*)0x4009C000)
|
||||
#define U3DLM (*(volatile uint32_t*)0x4009C004)
|
||||
#define U3IER (*(volatile uint32_t*)0x4009C004)
|
||||
#define U3IIR (*(volatile uint32_t*)0x4009C008)
|
||||
#define U3FCR (*(volatile uint32_t*)0x4009C008)
|
||||
#define U3LCR (*(volatile uint32_t*)0x4009C00C)
|
||||
#define U3LSR (*(volatile uint32_t*)0x4009C014)
|
||||
#define U3SCR (*(volatile uint32_t*)0x4009C01C)
|
||||
#define U3ACR (*(volatile uint32_t*)0x4009C020)
|
||||
#define U3ICR (*(volatile uint32_t*)0x4009C024)
|
||||
#define U3FDR (*(volatile uint32_t*)0x4009C028)
|
||||
#define U3TER (*(volatile uint32_t*)0x4009C030)
|
||||
|
||||
/* CAN1,CAN2 */
|
||||
#define AFMR (*(volatile uint32_t*)0x4003C000)
|
||||
#define SFF_sa (*(volatile uint32_t*)0x4003C004)
|
||||
#define SFF_GRP_sa (*(volatile uint32_t*)0x4003C008)
|
||||
#define EFF_sa (*(volatile uint32_t*)0x4003C00C)
|
||||
#define EFF_GRP_sa (*(volatile uint32_t*)0x4003C010)
|
||||
#define ENDofTable (*(volatile uint32_t*)0x4003C014)
|
||||
#define LUTerrAd (*(volatile uint32_t*)0x4003C018)
|
||||
#define LUTerr (*(volatile uint32_t*)0x4003C01C)
|
||||
|
||||
#define CANTxSR (*(volatile uint32_t*)0x40040000)
|
||||
#define CANRxSR (*(volatile uint32_t*)0x40040004)
|
||||
#define CANMSR (*(volatile uint32_t*)0x40040008)
|
||||
#define CAN1MOD (*(volatile uint32_t*)0x40044000)
|
||||
#define CAN1CMR (*(volatile uint32_t*)0x40044004)
|
||||
#define CAN1GSR (*(volatile uint32_t*)0x40044008)
|
||||
#define CAN1ICR (*(volatile uint32_t*)0x4004400C)
|
||||
#define CAN1IER (*(volatile uint32_t*)0x40044010)
|
||||
#define CAN1BTR (*(volatile uint32_t*)0x40044014)
|
||||
#define CAN1EWL (*(volatile uint32_t*)0x40044018)
|
||||
#define CAN1SR (*(volatile uint32_t*)0x4004401C)
|
||||
#define CAN1RFS (*(volatile uint32_t*)0x40044020)
|
||||
#define CAN1RID (*(volatile uint32_t*)0x40044024)
|
||||
#define CAN1RDA (*(volatile uint32_t*)0x40044028)
|
||||
#define CAN1RDB (*(volatile uint32_t*)0x4004402C)
|
||||
#define CAN1TFI1 (*(volatile uint32_t*)0x40044030)
|
||||
#define CAN1TID1 (*(volatile uint32_t*)0x40044034)
|
||||
#define CAN1TDA1 (*(volatile uint32_t*)0x40044038)
|
||||
#define CAN1TDB1 (*(volatile uint32_t*)0x4004403C)
|
||||
#define CAN1TFI2 (*(volatile uint32_t*)0x40044040)
|
||||
#define CAN1TID2 (*(volatile uint32_t*)0x40044044)
|
||||
#define CAN1TDA2 (*(volatile uint32_t*)0x40044048)
|
||||
#define CAN1TDB2 (*(volatile uint32_t*)0x4004404C)
|
||||
#define CAN1TFI3 (*(volatile uint32_t*)0x40044050)
|
||||
#define CAN1TID3 (*(volatile uint32_t*)0x40044054)
|
||||
#define CAN1TDA3 (*(volatile uint32_t*)0x40044058)
|
||||
#define CAN1TDB3 (*(volatile uint32_t*)0x4004405C)
|
||||
|
||||
#define CAN2MOD (*(volatile uint32_t*)0x40048000)
|
||||
#define CAN2CMR (*(volatile uint32_t*)0x40048004)
|
||||
#define CAN2GSR (*(volatile uint32_t*)0x40048008)
|
||||
#define CAN2ICR (*(volatile uint32_t*)0x4004800C)
|
||||
#define CAN2IER (*(volatile uint32_t*)0x40048010)
|
||||
#define CAN2BTR (*(volatile uint32_t*)0x40048014)
|
||||
#define CAN2EWL (*(volatile uint32_t*)0x40048018)
|
||||
#define CAN2SR (*(volatile uint32_t*)0x4004801C)
|
||||
#define CAN2RFS (*(volatile uint32_t*)0x40048020)
|
||||
#define CAN2RID (*(volatile uint32_t*)0x40048024)
|
||||
#define CAN2RDA (*(volatile uint32_t*)0x40048028)
|
||||
#define CAN2RDB (*(volatile uint32_t*)0x4004802C)
|
||||
#define CAN2TFI1 (*(volatile uint32_t*)0x40048030)
|
||||
#define CAN2TID1 (*(volatile uint32_t*)0x40048034)
|
||||
#define CAN2TDA1 (*(volatile uint32_t*)0x40048038)
|
||||
#define CAN2TDB1 (*(volatile uint32_t*)0x4004803C)
|
||||
#define CAN2TFI2 (*(volatile uint32_t*)0x40048040)
|
||||
#define CAN2TID2 (*(volatile uint32_t*)0x40048044)
|
||||
#define CAN2TDA2 (*(volatile uint32_t*)0x40048048)
|
||||
#define CAN2TDB2 (*(volatile uint32_t*)0x4004804C)
|
||||
#define CAN2TFI3 (*(volatile uint32_t*)0x40048050)
|
||||
#define CAN2TID3 (*(volatile uint32_t*)0x40048054)
|
||||
#define CAN2TDA3 (*(volatile uint32_t*)0x40048058)
|
||||
#define CAN2TDB3 (*(volatile uint32_t*)0x4004805C)
|
||||
|
||||
/* SPI0 */
|
||||
#define S0SPCR (*(volatile uint32_t*)0x40020000)
|
||||
#define S0SPSR (*(volatile uint32_t*)0x40020004)
|
||||
#define S0SPDR (*(volatile uint32_t*)0x40020008)
|
||||
#define S0SPCCR (*(volatile uint32_t*)0x4002000C)
|
||||
#define S0SPINT (*(volatile uint32_t*)0x4002001C)
|
||||
|
||||
/* SSP0,SSP1 */
|
||||
#define SSP0CR0 (*(volatile uint32_t*)0x40088000)
|
||||
#define SSP0CR1 (*(volatile uint32_t*)0x40088004)
|
||||
#define SSP0DR (*(volatile uint32_t*)0x40088008)
|
||||
#define SSP0SR (*(volatile uint32_t*)0x4008800C)
|
||||
#define SSP0CPSR (*(volatile uint32_t*)0x40088010)
|
||||
#define SSP0IMSC (*(volatile uint32_t*)0x40088014)
|
||||
#define SSP0RIS (*(volatile uint32_t*)0x40088018)
|
||||
#define SSP0MIS (*(volatile uint32_t*)0x4008801C)
|
||||
#define SSP0ICR (*(volatile uint32_t*)0x40088020)
|
||||
#define SSP0DMACR (*(volatile uint32_t*)0x40088024)
|
||||
#define SSP1CR0 (*(volatile uint32_t*)0x40030000)
|
||||
#define SSP1CR1 (*(volatile uint32_t*)0x40030004)
|
||||
#define SSP1DR (*(volatile uint32_t*)0x40030008)
|
||||
#define SSP1SR (*(volatile uint32_t*)0x4003000C)
|
||||
#define SSP1CPSR (*(volatile uint32_t*)0x40030010)
|
||||
#define SSP1IMSC (*(volatile uint32_t*)0x40030014)
|
||||
#define SSP1RIS (*(volatile uint32_t*)0x40030018)
|
||||
#define SSP1MIS (*(volatile uint32_t*)0x4003001C)
|
||||
#define SSP1ICR (*(volatile uint32_t*)0x40030020)
|
||||
#define SSP1DMACR (*(volatile uint32_t*)0x40030024)
|
||||
|
||||
/* I2C0,I2C1,I2C2 */
|
||||
#define I2C0CONSET (*(volatile uint32_t*)0x4001C000)
|
||||
#define I2C0STAT (*(volatile uint32_t*)0x4001C004)
|
||||
#define I2C0DAT (*(volatile uint32_t*)0x4001C008)
|
||||
#define I2C0ADR0 (*(volatile uint32_t*)0x4001C00C)
|
||||
#define I2C0SCLH (*(volatile uint32_t*)0x4001C010)
|
||||
#define I2C0SCLL (*(volatile uint32_t*)0x4001C014)
|
||||
#define I2C0CONCLR (*(volatile uint32_t*)0x4001C018)
|
||||
#define I2C0MMCTRL (*(volatile uint32_t*)0x4001C01C)
|
||||
#define I2C0ADR1 (*(volatile uint32_t*)0x4001C020)
|
||||
#define I2C0ADR2 (*(volatile uint32_t*)0x4001C024)
|
||||
#define I2C0ADR3 (*(volatile uint32_t*)0x4001C028)
|
||||
#define I2C0DATA_BUFFER (*(volatile uint32_t*)0x4001C02C)
|
||||
#define I2C0MASK ( (volatile uint32_t*)0x4001C030)
|
||||
#define I2C0MASK0 (*(volatile uint32_t*)0x4001C030)
|
||||
#define I2C0MASK1 (*(volatile uint32_t*)0x4001C034)
|
||||
#define I2C0MASK2 (*(volatile uint32_t*)0x4001C038)
|
||||
#define I2C0MASK3 (*(volatile uint32_t*)0x4001C03C)
|
||||
#define I2C1CONSET (*(volatile uint32_t*)0x4005C000)
|
||||
#define I2C1STAT (*(volatile uint32_t*)0x4005C004)
|
||||
#define I2C1DAT (*(volatile uint32_t*)0x4005C008)
|
||||
#define I2C1ADR0 (*(volatile uint32_t*)0x4005C00C)
|
||||
#define I2C1SCLH (*(volatile uint32_t*)0x4005C010)
|
||||
#define I2C1SCLL (*(volatile uint32_t*)0x4005C014)
|
||||
#define I2C1CONCLR (*(volatile uint32_t*)0x4005C018)
|
||||
#define I2C1MMCTRL (*(volatile uint32_t*)0x4005C01C)
|
||||
#define I2C1ADR1 (*(volatile uint32_t*)0x4005C020)
|
||||
#define I2C1ADR2 (*(volatile uint32_t*)0x4005C024)
|
||||
#define I2C1ADR3 (*(volatile uint32_t*)0x4005C028)
|
||||
#define I2C1DATA_BUFFER (*(volatile uint32_t*)0x4005C02C)
|
||||
#define I2C1MASK ( (volatile uint32_t*)0x4005C030)
|
||||
#define I2C1MASK0 (*(volatile uint32_t*)0x4005C030)
|
||||
#define I2C1MASK1 (*(volatile uint32_t*)0x4005C034)
|
||||
#define I2C1MASK2 (*(volatile uint32_t*)0x4005C038)
|
||||
#define I2C1MASK3 (*(volatile uint32_t*)0x4005C03C)
|
||||
#define I2C2CONSET (*(volatile uint32_t*)0x400A0000)
|
||||
#define I2C2STAT (*(volatile uint32_t*)0x400A0004)
|
||||
#define I2C2DAT (*(volatile uint32_t*)0x400A0008)
|
||||
#define I2C2ADR0 (*(volatile uint32_t*)0x400A000C)
|
||||
#define I2C2SCLH (*(volatile uint32_t*)0x400A0010)
|
||||
#define I2C2SCLL (*(volatile uint32_t*)0x400A0014)
|
||||
#define I2C2CONCLR (*(volatile uint32_t*)0x400A0018)
|
||||
#define I2C2MMCTRL (*(volatile uint32_t*)0x400A001C)
|
||||
#define I2C2ADR1 (*(volatile uint32_t*)0x400A0020)
|
||||
#define I2C2ADR2 (*(volatile uint32_t*)0x400A0024)
|
||||
#define I2C2ADR3 (*(volatile uint32_t*)0x400A0028)
|
||||
#define I2C2DATA_BUFFER (*(volatile uint32_t*)0x400A002C)
|
||||
#define I2C2MASK ( (volatile uint32_t*)0x400A0030)
|
||||
#define I2C2MASK0 (*(volatile uint32_t*)0x400A0030)
|
||||
#define I2C2MASK1 (*(volatile uint32_t*)0x400A0034)
|
||||
#define I2C2MASK2 (*(volatile uint32_t*)0x400A0038)
|
||||
#define I2C2MASK3 (*(volatile uint32_t*)0x400A003C)
|
||||
|
||||
/* I2S */
|
||||
#define I2SDAO (*(volatile uint32_t*)0x400A8000)
|
||||
#define I2SDAI (*(volatile uint32_t*)0x400A8004)
|
||||
#define I2STXFIFO (*(volatile uint32_t*)0x400A8008)
|
||||
#define I2SRXFIFO (*(volatile uint32_t*)0x400A800C)
|
||||
#define I2SSTATE (*(volatile uint32_t*)0x400A8010)
|
||||
#define I2SDMA1 (*(volatile uint32_t*)0x400A8014)
|
||||
#define I2SDMA2 (*(volatile uint32_t*)0x400A8018)
|
||||
#define I2SIRQ (*(volatile uint32_t*)0x400A801C)
|
||||
#define I2STXRATE (*(volatile uint32_t*)0x400A8020)
|
||||
#define I2SRXRATE (*(volatile uint32_t*)0x400A8024)
|
||||
#define I2STXBITRATE (*(volatile uint32_t*)0x400A8028)
|
||||
#define I2SRXBITRATE (*(volatile uint32_t*)0x400A802C)
|
||||
#define I2STXMODE (*(volatile uint32_t*)0x400A8030)
|
||||
#define I2SRXMODE (*(volatile uint32_t*)0x400A8034)
|
||||
|
||||
/* Timer0,Timer1,Timer2,Timer3 */
|
||||
#define T0IR (*(volatile uint32_t*)0x40004000)
|
||||
#define T0TCR (*(volatile uint32_t*)0x40004004)
|
||||
#define T0TC (*(volatile uint32_t*)0x40004008)
|
||||
#define T0PR (*(volatile uint32_t*)0x4000400C)
|
||||
#define T0PC (*(volatile uint32_t*)0x40004010)
|
||||
#define T0MCR (*(volatile uint32_t*)0x40004014)
|
||||
#define T0MR ( (volatile uint32_t*)0x40004018)
|
||||
#define T0MR0 (*(volatile uint32_t*)0x40004018)
|
||||
#define T0MR1 (*(volatile uint32_t*)0x4000401C)
|
||||
#define T0MR2 (*(volatile uint32_t*)0x40004020)
|
||||
#define T0MR3 (*(volatile uint32_t*)0x40004024)
|
||||
#define T0CCR (*(volatile uint32_t*)0x40004028)
|
||||
#define T0CR0 (*(volatile uint32_t*)0x4000402C)
|
||||
#define T0CR1 (*(volatile uint32_t*)0x40004030)
|
||||
#define T0EMR (*(volatile uint32_t*)0x4000403C)
|
||||
#define T0CTCR (*(volatile uint32_t*)0x40004070)
|
||||
|
||||
#define T1IR (*(volatile uint32_t*)0x40008000)
|
||||
#define T1TCR (*(volatile uint32_t*)0x40008004)
|
||||
#define T1TC (*(volatile uint32_t*)0x40008008)
|
||||
#define T1PR (*(volatile uint32_t*)0x4000800C)
|
||||
#define T1PC (*(volatile uint32_t*)0x40008010)
|
||||
#define T1MCR (*(volatile uint32_t*)0x40008014)
|
||||
#define T1MR ( (volatile uint32_t*)0x40008018)
|
||||
#define T1MR0 (*(volatile uint32_t*)0x40008018)
|
||||
#define T1MR1 (*(volatile uint32_t*)0x4000801C)
|
||||
#define T1MR2 (*(volatile uint32_t*)0x40008020)
|
||||
#define T1MR3 (*(volatile uint32_t*)0x40008024)
|
||||
#define T1CCR (*(volatile uint32_t*)0x40008028)
|
||||
#define T1CR0 (*(volatile uint32_t*)0x4000802C)
|
||||
#define T1CR1 (*(volatile uint32_t*)0x40008030)
|
||||
#define T1EMR (*(volatile uint32_t*)0x4000803C)
|
||||
#define T1CTCR (*(volatile uint32_t*)0x40008070)
|
||||
|
||||
#define T2IR (*(volatile uint32_t*)0x40090000)
|
||||
#define T2TCR (*(volatile uint32_t*)0x40090004)
|
||||
#define T2TC (*(volatile uint32_t*)0x40090008)
|
||||
#define T2PR (*(volatile uint32_t*)0x4009000C)
|
||||
#define T2PC (*(volatile uint32_t*)0x40090010)
|
||||
#define T2MCR (*(volatile uint32_t*)0x40090014)
|
||||
#define T2MR ( (volatile uint32_t*)0x40090018)
|
||||
#define T2MR0 (*(volatile uint32_t*)0x40090018)
|
||||
#define T2MR1 (*(volatile uint32_t*)0x4009001C)
|
||||
#define T2MR2 (*(volatile uint32_t*)0x40090020)
|
||||
#define T2MR3 (*(volatile uint32_t*)0x40090024)
|
||||
#define T2CCR (*(volatile uint32_t*)0x40090028)
|
||||
#define T2CR0 (*(volatile uint32_t*)0x4009002C)
|
||||
#define T2CR1 (*(volatile uint32_t*)0x40090030)
|
||||
#define T2EMR (*(volatile uint32_t*)0x4009003C)
|
||||
#define T2CTCR (*(volatile uint32_t*)0x40090070)
|
||||
|
||||
#define T3IR (*(volatile uint32_t*)0x40094000)
|
||||
#define T3TCR (*(volatile uint32_t*)0x40094004)
|
||||
#define T3TC (*(volatile uint32_t*)0x40094008)
|
||||
#define T3PR (*(volatile uint32_t*)0x4009400C)
|
||||
#define T3PC (*(volatile uint32_t*)0x40094010)
|
||||
#define T3MCR (*(volatile uint32_t*)0x40094014)
|
||||
#define T3MR ( (volatile uint32_t*)0x40094018)
|
||||
#define T3MR0 (*(volatile uint32_t*)0x40094018)
|
||||
#define T3MR1 (*(volatile uint32_t*)0x4009401C)
|
||||
#define T3MR2 (*(volatile uint32_t*)0x40094020)
|
||||
#define T3MR3 (*(volatile uint32_t*)0x40094024)
|
||||
#define T3CCR (*(volatile uint32_t*)0x40094028)
|
||||
#define T3CR0 (*(volatile uint32_t*)0x4009402C)
|
||||
#define T3CR1 (*(volatile uint32_t*)0x40094030)
|
||||
#define T3EMR (*(volatile uint32_t*)0x4009403C)
|
||||
#define T3CTCR (*(volatile uint32_t*)0x40094070)
|
||||
|
||||
/* Repeative Interrupt Timer */
|
||||
#define RICOMPVAL (*(volatile uint32_t*)0x400B0000)
|
||||
#define RIMASK (*(volatile uint32_t*)0x400B0004)
|
||||
#define RICTRL (*(volatile uint32_t*)0x400B0008)
|
||||
#define RICOUNTER (*(volatile uint32_t*)0x400B000C)
|
||||
|
||||
/* PWM1 */
|
||||
#define PWM1IR (*(volatile uint32_t*)0x40018000)
|
||||
#define PWM1TCR (*(volatile uint32_t*)0x40018004)
|
||||
#define PWM1TC (*(volatile uint32_t*)0x40018008)
|
||||
#define PWM1PR (*(volatile uint32_t*)0x4001800C)
|
||||
#define PWM1PC (*(volatile uint32_t*)0x40018010)
|
||||
#define PWM1MCR (*(volatile uint32_t*)0x40018014)
|
||||
#define PWM1MR0 (*(volatile uint32_t*)0x40018018)
|
||||
#define PWM1MR1 (*(volatile uint32_t*)0x4001801C)
|
||||
#define PWM1MR2 (*(volatile uint32_t*)0x40018020)
|
||||
#define PWM1MR3 (*(volatile uint32_t*)0x40018024)
|
||||
#define PWM1CCR (*(volatile uint32_t*)0x40018028)
|
||||
#define PWM1CR0 (*(volatile uint32_t*)0x4001802C)
|
||||
#define PWM1CR1 (*(volatile uint32_t*)0x40018030)
|
||||
#define PWM1CR2 (*(volatile uint32_t*)0x40018034)
|
||||
#define PWM1CR3 (*(volatile uint32_t*)0x40018038)
|
||||
#define PWM1MR4 (*(volatile uint32_t*)0x40018040)
|
||||
#define PWM1MR5 (*(volatile uint32_t*)0x40018044)
|
||||
#define PWM1MR6 (*(volatile uint32_t*)0x40018048)
|
||||
#define PWM1PCR (*(volatile uint32_t*)0x4001804C)
|
||||
#define PWM1LER (*(volatile uint32_t*)0x40018050)
|
||||
#define PWM1CTCR (*(volatile uint32_t*)0x40018070)
|
||||
|
||||
/* Motor Control PWM */
|
||||
#define MCCON (*(volatile uint32_t*)0x400B8000)
|
||||
#define MCCON_SET (*(volatile uint32_t*)0x400B8004)
|
||||
#define MCCON_CLR (*(volatile uint32_t*)0x400B8008)
|
||||
#define MCCAPCON (*(volatile uint32_t*)0x400B800C)
|
||||
#define MCCAPCON_SET (*(volatile uint32_t*)0x400B8010)
|
||||
#define MCCAPCON_CLR (*(volatile uint32_t*)0x400B8014)
|
||||
#define MCTC ( (volatile uint32_t*)0x400B8018)
|
||||
#define MCTC0 (*(volatile uint32_t*)0x400B8018)
|
||||
#define MCTC1 (*(volatile uint32_t*)0x400B801C)
|
||||
#define MCTC2 (*(volatile uint32_t*)0x400B8020)
|
||||
#define MCLIM ( (volatile uint32_t*)0x400B8024)
|
||||
#define MCLIM0 (*(volatile uint32_t*)0x400B8024)
|
||||
#define MCLIM1 (*(volatile uint32_t*)0x400B8028)
|
||||
#define MCLIM2 (*(volatile uint32_t*)0x400B802C)
|
||||
#define MCMAT ( (volatile uint32_t*)0x400B8030)
|
||||
#define MCMAT0 (*(volatile uint32_t*)0x400B8030)
|
||||
#define MCMAT1 (*(volatile uint32_t*)0x400B8034)
|
||||
#define MCMAT2 (*(volatile uint32_t*)0x400B8038)
|
||||
#define MCDT (*(volatile uint32_t*)0x400B803C)
|
||||
#define MCCP (*(volatile uint32_t*)0x400B8040)
|
||||
#define MCCAP ( (volatile uint32_t*)0x400B8044)
|
||||
#define MCCAP0 (*(volatile uint32_t*)0x400B8044)
|
||||
#define MCCAP1 (*(volatile uint32_t*)0x400B8048)
|
||||
#define MCCAP2 (*(volatile uint32_t*)0x400B804C)
|
||||
#define MCINTEN (*(volatile uint32_t*)0x400B8050)
|
||||
#define MCINTEN_SET (*(volatile uint32_t*)0x400B8054)
|
||||
#define MCINTEN_CLR (*(volatile uint32_t*)0x400B8058)
|
||||
#define MCCNTCON (*(volatile uint32_t*)0x400B805C)
|
||||
#define MCCNTCON_SET (*(volatile uint32_t*)0x400B8060)
|
||||
#define MCCNTCON_CLR (*(volatile uint32_t*)0x400B8064)
|
||||
#define MCINTF (*(volatile uint32_t*)0x400B8068)
|
||||
#define MCINTF_SET (*(volatile uint32_t*)0x400B806C)
|
||||
#define MCINTF_CLR (*(volatile uint32_t*)0x400B8070)
|
||||
#define MCCAP_CLR (*(volatile uint32_t*)0x400B8074)
|
||||
|
||||
/* Quadrature Encoder Interface */
|
||||
#define QEICON (*(volatile uint32_t*)0x400BC000)
|
||||
#define QEICONF (*(volatile uint32_t*)0x400BC008)
|
||||
#define QEISTAT (*(volatile uint32_t*)0x400BC004)
|
||||
#define QEIPOS (*(volatile uint32_t*)0x400BC00C)
|
||||
#define QEIMAXPOS (*(volatile uint32_t*)0x400BC010)
|
||||
#define CMPOS0 (*(volatile uint32_t*)0x400BC014)
|
||||
#define CMPOS1 (*(volatile uint32_t*)0x400BC018)
|
||||
#define CMPOS2 (*(volatile uint32_t*)0x400BC01C)
|
||||
#define INXCNT (*(volatile uint32_t*)0x400BC020)
|
||||
#define INXCMP (*(volatile uint32_t*)0x400BC024)
|
||||
#define QEILOAD (*(volatile uint32_t*)0x400BC028)
|
||||
#define QEITIME (*(volatile uint32_t*)0x400BC02C)
|
||||
#define QEIVEL (*(volatile uint32_t*)0x400BC030)
|
||||
#define QEICAP (*(volatile uint32_t*)0x400BC034)
|
||||
#define VELCOMP (*(volatile uint32_t*)0x400BC038)
|
||||
#define FILTER (*(volatile uint32_t*)0x400BC03C)
|
||||
#define QEIINTSTAT (*(volatile uint32_t*)0x400BCFE0)
|
||||
#define QEISET (*(volatile uint32_t*)0x400BCFEC)
|
||||
#define QEICLR (*(volatile uint32_t*)0x400BCFE8)
|
||||
#define QEIIE (*(volatile uint32_t*)0x400BCFE4)
|
||||
#define QEIIES (*(volatile uint32_t*)0x400BCFDC)
|
||||
#define QEIIEC (*(volatile uint32_t*)0x400BCFD8)
|
||||
|
||||
/* RTC */
|
||||
#define RTC_ILR (*(volatile uint32_t*)0x40024000)
|
||||
#define RTC_CCR (*(volatile uint32_t*)0x40024008)
|
||||
#define RTC_CIIR (*(volatile uint32_t*)0x4002400C)
|
||||
#define RTC_AMR (*(volatile uint32_t*)0x40024010)
|
||||
#define RTC_AUX (*(volatile uint32_t*)0x4002405C)
|
||||
#define RTC_AUXEN (*(volatile uint32_t*)0x40024058)
|
||||
#define RTC_CTIME0 (*(volatile uint32_t*)0x40024014)
|
||||
#define RTC_CTIME1 (*(volatile uint32_t*)0x40024018)
|
||||
#define RTC_CTIME2 (*(volatile uint32_t*)0x4002401C)
|
||||
#define RTC_SEC (*(volatile uint32_t*)0x40024020)
|
||||
#define RTC_MIN (*(volatile uint32_t*)0x40024024)
|
||||
#define RTC_HOUR (*(volatile uint32_t*)0x40024028)
|
||||
#define RTC_DOM (*(volatile uint32_t*)0x4002402C)
|
||||
#define RTC_DOW (*(volatile uint32_t*)0x40024030)
|
||||
#define RTC_DOY (*(volatile uint32_t*)0x40024034)
|
||||
#define RTC_MONTH (*(volatile uint32_t*)0x40024038)
|
||||
#define RTC_YEAR (*(volatile uint32_t*)0x4002403C)
|
||||
#define RTC_CALIBRATION (*(volatile uint32_t*)0x40024040)
|
||||
#define RTC_GPREG ( (volatile uint32_t*)0x40024044)
|
||||
#define RTC_GPREG0 (*(volatile uint32_t*)0x40024044)
|
||||
#define RTC_GPREG1 (*(volatile uint32_t*)0x40024048)
|
||||
#define RTC_GPREG2 (*(volatile uint32_t*)0x4002404C)
|
||||
#define RTC_GPREG3 (*(volatile uint32_t*)0x40024050)
|
||||
#define RTC_GPREG4 (*(volatile uint32_t*)0x40024054)
|
||||
#define RTC_ALSEC (*(volatile uint32_t*)0x40024060)
|
||||
#define RTC_ALMIN (*(volatile uint32_t*)0x40024064)
|
||||
#define RTC_ALHOUR (*(volatile uint32_t*)0x40024068)
|
||||
#define RTC_ALDOM (*(volatile uint32_t*)0x4002406C)
|
||||
#define RTC_ALDOW (*(volatile uint32_t*)0x40024070)
|
||||
#define RTC_ALDOY (*(volatile uint32_t*)0x40024074)
|
||||
#define RTC_ALMON (*(volatile uint32_t*)0x40024078)
|
||||
#define RTC_ALYEAR (*(volatile uint32_t*)0x4002407C)
|
||||
|
||||
/* WDT */
|
||||
#define WDMOD (*(volatile uint32_t*)0x40000000)
|
||||
#define WDTC (*(volatile uint32_t*)0x40000004)
|
||||
#define WDFEED (*(volatile uint32_t*)0x40000008)
|
||||
#define WDTV (*(volatile uint32_t*)0x4000000C)
|
||||
#define WDCLKSEL (*(volatile uint32_t*)0x40000010)
|
||||
|
||||
/* ADC0 */
|
||||
#define AD0CR (*(volatile uint32_t*)0x40034000)
|
||||
#define AD0GDR (*(volatile uint32_t*)0x40034004)
|
||||
#define AD0INTEN (*(volatile uint32_t*)0x4003400C)
|
||||
#define AD0DR ( (volatile uint32_t*)0x40034010)
|
||||
#define AD0DR0 (*(volatile uint32_t*)0x40034010)
|
||||
#define AD0DR1 (*(volatile uint32_t*)0x40034014)
|
||||
#define AD0DR2 (*(volatile uint32_t*)0x40034018)
|
||||
#define AD0DR3 (*(volatile uint32_t*)0x4003401C)
|
||||
#define AD0DR4 (*(volatile uint32_t*)0x40034020)
|
||||
#define AD0DR5 (*(volatile uint32_t*)0x40034024)
|
||||
#define AD0DR6 (*(volatile uint32_t*)0x40034028)
|
||||
#define AD0DR7 (*(volatile uint32_t*)0x4003402C)
|
||||
#define AD0STAT (*(volatile uint32_t*)0x40034030)
|
||||
#define AD0TRM (*(volatile uint32_t*)0x40034034)
|
||||
|
||||
/* DAC */
|
||||
#define DACR (*(volatile uint32_t*)0x4008C000)
|
||||
#define DACCTRL (*(volatile uint32_t*)0x4008C004)
|
||||
#define DACCNTVAL (*(volatile uint32_t*)0x4008C008)
|
||||
|
||||
/* GPDMA */
|
||||
#define DMACIntStat (*(volatile uint32_t*)0x50004000)
|
||||
#define DMACIntTCStat (*(volatile uint32_t*)0x50004004)
|
||||
#define DMACIntTCClear (*(volatile uint32_t*)0x50004008)
|
||||
#define DMACIntErrStat (*(volatile uint32_t*)0x5000400C)
|
||||
#define DMACIntErrClr (*(volatile uint32_t*)0x50004010)
|
||||
#define DMACRawIntTCStat (*(volatile uint32_t*)0x50004014)
|
||||
#define DMACRawIntErrStat (*(volatile uint32_t*)0x50004018)
|
||||
#define DMACEnbldChns (*(volatile uint32_t*)0x5000401C)
|
||||
#define DMACSoftBReq (*(volatile uint32_t*)0x50004020)
|
||||
#define DMACSoftSReq (*(volatile uint32_t*)0x50004024)
|
||||
#define DMACSoftLBReq (*(volatile uint32_t*)0x50004028)
|
||||
#define DMACSoftLSReq (*(volatile uint32_t*)0x5000402C)
|
||||
#define DMACConfig (*(volatile uint32_t*)0x50004030)
|
||||
#define DMACSync (*(volatile uint32_t*)0x50004034)
|
||||
#define DMAREQSEL (*(volatile uint32_t*)0x400FC1C4)
|
||||
#define DMACC0SrcAddr (*(volatile uint32_t*)0x50004100)
|
||||
#define DMACC0DestAddr (*(volatile uint32_t*)0x50004104)
|
||||
#define DMACC0LLI (*(volatile uint32_t*)0x50004108)
|
||||
#define DMACC0Control (*(volatile uint32_t*)0x5000410C)
|
||||
#define DMACC0Config (*(volatile uint32_t*)0x50004110)
|
||||
#define DMACC1SrcAddr (*(volatile uint32_t*)0x50004120)
|
||||
#define DMACC1DestAddr (*(volatile uint32_t*)0x50004124)
|
||||
#define DMACC1LLI (*(volatile uint32_t*)0x50004128)
|
||||
#define DMACC1Control (*(volatile uint32_t*)0x5000412C)
|
||||
#define DMACC1Config (*(volatile uint32_t*)0x50004130)
|
||||
#define DMACC2SrcAddr (*(volatile uint32_t*)0x50004140)
|
||||
#define DMACC2DestAddr (*(volatile uint32_t*)0x50004144)
|
||||
#define DMACC2LLI (*(volatile uint32_t*)0x50004148)
|
||||
#define DMACC2Control (*(volatile uint32_t*)0x5000414C)
|
||||
#define DMACC2Config (*(volatile uint32_t*)0x50004150)
|
||||
#define DMACC3SrcAddr (*(volatile uint32_t*)0x50004160)
|
||||
#define DMACC3DestAddr (*(volatile uint32_t*)0x50004164)
|
||||
#define DMACC3LLI (*(volatile uint32_t*)0x50004168)
|
||||
#define DMACC3Control (*(volatile uint32_t*)0x5000416C)
|
||||
#define DMACC3Config (*(volatile uint32_t*)0x50004170)
|
||||
#define DMACC4SrcAddr (*(volatile uint32_t*)0x50004180)
|
||||
#define DMACC4DestAddr (*(volatile uint32_t*)0x50004184)
|
||||
#define DMACC4LLI (*(volatile uint32_t*)0x50004188)
|
||||
#define DMACC4Control (*(volatile uint32_t*)0x5000418C)
|
||||
#define DMACC4Config (*(volatile uint32_t*)0x50004190)
|
||||
#define DMACC5SrcAddr (*(volatile uint32_t*)0x500041A0)
|
||||
#define DMACC5DestAddr (*(volatile uint32_t*)0x500041A4)
|
||||
#define DMACC5LLI (*(volatile uint32_t*)0x500041A8)
|
||||
#define DMACC5Control (*(volatile uint32_t*)0x500041AC)
|
||||
#define DMACC5Config (*(volatile uint32_t*)0x500041B0)
|
||||
#define DMACC6SrcAddr (*(volatile uint32_t*)0x500041C0)
|
||||
#define DMACC6DestAddr (*(volatile uint32_t*)0x500041C4)
|
||||
#define DMACC6LLI (*(volatile uint32_t*)0x500041C8)
|
||||
#define DMACC6Control (*(volatile uint32_t*)0x500041CC)
|
||||
#define DMACC6Config (*(volatile uint32_t*)0x500041D0)
|
||||
#define DMACC7SrcAddr (*(volatile uint32_t*)0x500041E0)
|
||||
#define DMACC7DestAddr (*(volatile uint32_t*)0x500041E4)
|
||||
#define DMACC7LLI (*(volatile uint32_t*)0x500041E8)
|
||||
#define DMACC7Control (*(volatile uint32_t*)0x500041EC)
|
||||
#define DMACC7Config (*(volatile uint32_t*)0x500041F0)
|
||||
|
||||
|
||||
/* Cortex-M3 System timer */
|
||||
#define SYST_CSR (*(volatile uint32_t*)0xE000E010)
|
||||
#define SYST_RVR (*(volatile uint32_t*)0xE000E014)
|
||||
#define SYST_CVR (*(volatile uint32_t*)0xE000E018)
|
||||
#define SYST_CALIB (*(volatile uint32_t*)0xE000E01C)
|
||||
|
||||
/* Cortex-M3 NVIC */
|
||||
#define ISER ( (volatile uint32_t*)0xE000E100)
|
||||
#define ICER ( (volatile uint32_t*)0xE000E180)
|
||||
#define ISPR ( (volatile uint32_t*)0xE000E200)
|
||||
#define ICPR ( (volatile uint32_t*)0xE000E280)
|
||||
#define IABR ( (volatile uint32_t*)0xE000E300)
|
||||
#define IPR ( (volatile uint8_t *)0xE000E400)
|
||||
#define STIR (*(volatile uint32_t*)0xE000EF00)
|
||||
|
||||
/* Cortex-M3 SCB */
|
||||
#define ACTLR (*(volatile uint32_t*)0xE000E008)
|
||||
#define CPUID (*(volatile uint32_t*)0xE000ED00)
|
||||
#define ICSR (*(volatile uint32_t*)0xE000ED04)
|
||||
#define VTOR (*(volatile uint32_t*)0xE000ED08)
|
||||
#define AIRCR (*(volatile uint32_t*)0xE000ED0C)
|
||||
#define SCR (*(volatile uint32_t*)0xE000ED10)
|
||||
#define CCR (*(volatile uint32_t*)0xE000ED14)
|
||||
#define SHPR ( (volatile uint8_t *)0xE000ED14)
|
||||
#define CFSR (*(volatile uint32_t*)0xE000ED28)
|
||||
#define MMSR (*(volatile uint32_t*)0xE000ED28)
|
||||
#define BFSR (*(volatile uint32_t*)0xE000ED29)
|
||||
#define UFSR (*(volatile uint32_t*)0xE000ED2A)
|
||||
#define HFSR (*(volatile uint32_t*)0xE000ED2C)
|
||||
#define MMFAR (*(volatile uint32_t*)0xE000ED34)
|
||||
#define BFAR (*(volatile uint32_t*)0xE000ED38)
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------*/
|
||||
/* Cortex-M3 core/peripheral access macros */
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
/* These are for only privileged mode */
|
||||
#define __enable_irq() asm volatile ("CPSIE i\n")
|
||||
#define __disable_irq() asm volatile ("CPSID i\n")
|
||||
#define __enable_irqn(n) ISER[(n) / 32] = 1 << ((n) % 32)
|
||||
#define __disable_irqn(n) ICER[(n) / 32] = 1 << ((n) % 32)
|
||||
#define __test_irqn_enabled(n) (ISER[(n) / 32] & (1 << ((n) % 32)))
|
||||
#define __set_irqn(n) ISPR[(n) / 32] = 1 << ((n) % 32)
|
||||
#define __clear_irqn(n) ICPR[(n) / 32] = 1 << ((n) % 32)
|
||||
#define __test_irqn(n) (ICPR[(n) / 32] & (1 << ((n) % 32)))
|
||||
#define __test_irqn_active(n) (IABR[n / 32] & (1 << ((n) % 32)))
|
||||
#define __set_irqn_priority(n,v) IPR[n] = (v)
|
||||
#define __set_faultn_priority(n,v) SHPR[(n) + 16] = (v)
|
||||
#define __get_MSP() ({uint32_t __rv; asm ("MRS %0, MSP\n" : "=r" (__rv)); __rv;})
|
||||
#define __get_PSP() ({uint32_t __rv; asm ("MRS %0, PSP\n" : "=r" (__rv)); __rv;})
|
||||
#define __get_PRIMASK() ({uint32_t __rv; asm ("MRS %0, PRIMASK\n" : "=r" (__rv)); __rv;})
|
||||
#define __get_FAULTMASK() ({uint32_t __rv; asm ("MRS %0, FAULTMASK\n" : "=r" (__rv)); __rv;})
|
||||
#define __get_BASEPRI() ({uint32_t __rv; asm ("MRS %0, BASEPRI\n" : "=r" (__rv)); __rv;})
|
||||
#define __get_CONTROL() ({uint32_t __rv; asm ("MRS %0, CONTROL\n" : "=r" (__rv)); __rv;})
|
||||
#define __set_MSP(arg) {uint32_t __v=arg; asm ("MSR MSP, %0\n" :: "r" (__v));}
|
||||
#define __set_PSP(arg) {uint32_t __v=arg; asm ("MSR PSP, %0\n" :: "r" (__v));}
|
||||
#define __set_PRIMASK(arg) {uint32_t __v=arg; asm ("MSR PRIMASK, %0\n" :: "r" (__v));}
|
||||
#define __set_FAULTMASK(arg) {uint32_t __v=arg; asm ("MSR FAULTMASK, %0\n" :: "r" (__v));}
|
||||
#define __set_BASEPRI(arg) {uint32_t __v=arg; asm ("MSR BASEPRI, %0\n" :: "r" (__v));}
|
||||
#define __set_CONTORL(arg) {uint32_t __v=arg; asm ("MSR CONTROL, %0\nISB\n" :: "r" (__v));}
|
||||
|
||||
/* These functions and macros are alternative of above for user mode */
|
||||
#if USE_SV_SERVICE
|
||||
#define __enable_irq_user() asm volatile ("SVC #0\n") /* CPSIE i */
|
||||
#define __disable_irq_user() asm volatile ("SVC #1\n") /* CPSID i */
|
||||
#define __enable_irq_user() asm volatile ("SVC #2\n") /* CPSIE f */
|
||||
#define __disable_irq_user() asm volatile ("SVC #3\n") /* CPSID f */
|
||||
uint32_t __get_scs_reg (volatile uint32_t* reg); /* Read a register in SCS */
|
||||
void __set_scs_reg (volatile uint32_t* reg, uint32_t val); /* Write a register in SCS */
|
||||
#define __enable_irqn_user(n) __set_scs_reg(&ISER[((n) / 32)], 1 << ((n) % 32))
|
||||
#define __disable_irqn_user(n) __set_scs_reg(&ISCR[((n) / 32)], 1 << ((n) % 32))
|
||||
#define __test_irqn_enabled_user(n) (__get_scs_reg(&ISCR[(n) / 32]) & (1 << ((n) % 32)))
|
||||
#define __set_irqn_user(n) __set_scs_reg(&ISPR[((n) / 32)], 1 << ((n) % 32))
|
||||
#define __clear_irqn_user(n) __set_scs_reg(&ICPR[((n) / 32)], 1 << ((n) % 32))
|
||||
#define __test_irqn_user(n) (__get_scs_reg(&ICPR[(n) / 32]) & (1 << ((n) % 32)))
|
||||
#define __test_active_irqn_user(n) (__get_scs_reg(&IABR[(n) / 32]) & (1 << ((n) % 32)))
|
||||
#define __set_irqn_priority_user(n,v) __set_scs_reg(&IPR[n], (v))
|
||||
#define __set_faultn_priority_user(n,v) __set_scs_reg(&SHPR[(n) + 16], (v))
|
||||
#endif
|
||||
|
||||
/* These functions/macros can be used at user/privileged mode */
|
||||
#define __REV(arg) ({uint32_t __r, __v=arg; asm ("REV %0,%1\n" : "=r" (__r) : "r" (__v) ); __r;})
|
||||
#define __REV16(arg) ({uint32_t __r, __v=arg; asm ("REV16 %0,%1\n" : "=r" (__r) : "r" (__v) ); __r;})
|
||||
#define __REVSH(arg) ({uint32_t __r, __v=arg; asm ("REVSH %0,%1\n" : "=r" (__r) : "r" (__v) ); __r;})
|
||||
#define __RBIT(arg) ({uint32_t __r, __v=arg; asm ("RBIT %0,%1\n" : "=r" (__r) : "r" (__v) ); __r;})
|
||||
#define __LDREXB(p) ({uint8_t __r; asm ("LDREXB %0,[%1]\n" : "=r" (__r) : "r" (p)); __r;})
|
||||
#define __LDREXH(p) ({uint16_t __r; asm ("LDREXH %0,[%1]\n" : "=r" (__r) : "r" (p)); __r;})
|
||||
#define __LDREXW(p) ({uint32_t __r; asm ("LDREX %0,[%1]\n" : "=r" (__r) : "r" (p)); __r;})
|
||||
#define __STREXB(d,p) ({register uint32_t __r asm("r2"); register uint8_t __d asm("r1") = d; register volatile uint8_t *__p asm("r0") = p; asm ("STREXB %0,%2,[%1]\n" : "=r" (__r) : "r" (__p), "r" (__d)); __r;})
|
||||
#define __STREXH(d,p) ({register uint32_t __r asm("r2"); register uint16_t __d asm("r1") = d; register volatile uint16_t *__p asm("r0") = p; asm ("STREXH %0,%2,[%1]\n" : "=r" (__r) : "r" (p), "r" (__d)); __r;})
|
||||
#define __STREXW(d,p) ({register uint32_t __r asm("r2"); register uint32_t __d asm("r1") = d; register volatile uint32_t *__p asm("r0") = p; asm ("STREX %0,%2,[%1]\n" : "=r" (__r) : "r" (p), "r" (__d)); __r;})
|
||||
#define __CLREX() asm volatile ("CLREX\n")
|
||||
#define __SEV() asm volatile ("SEV\n")
|
||||
#define __WFE() asm volatile ("WFE\n")
|
||||
#define __WFI() asm volatile ("WFI\n")
|
||||
|
||||
/* LPC176x IRQ number */
|
||||
#define MemManage_IRQn (-12)
|
||||
#define BusFault_IRQn (-11)
|
||||
#define UsageFault_IRQn (-10)
|
||||
#define SVC_IRQn (-5)
|
||||
#define DebugMon_IRQn (-4)
|
||||
#define PendSV_IRQn (-2)
|
||||
#define SysTick_IRQn (-1)
|
||||
#define WDT_IRQn 0
|
||||
#define TIMER0_IRQn 1
|
||||
#define TIMER1_IRQn 2
|
||||
#define TIMER2_IRQn 3
|
||||
#define TIMER3_IRQn 4
|
||||
#define UART0_IRQn 5
|
||||
#define UART1_IRQn 6
|
||||
#define UART2_IRQn 7
|
||||
#define UART3_IRQn 8
|
||||
#define PWM1_IRQn 9
|
||||
#define I2C0_IRQn 10
|
||||
#define I2C1_IRQn 11
|
||||
#define I2C2_IRQn 12
|
||||
#define SPI_IRQn 13
|
||||
#define SSP0_IRQn 14
|
||||
#define SSP1_IRQn 15
|
||||
#define PLL0_IRQn 16
|
||||
#define RTC_IRQn 17
|
||||
#define EINT0_IRQn 18
|
||||
#define EINT1_IRQn 19
|
||||
#define EINT2_IRQn 20
|
||||
#define EINT3_IRQn 21
|
||||
#define ADC_IRQn 22
|
||||
#define BOD_IRQn 23
|
||||
#define USB_IRQn 24
|
||||
#define CAN_IRQn 25
|
||||
#define GPDMA_IRQn 26
|
||||
#define I2S_IRQn 27
|
||||
#define ETHER_IRQn 28
|
||||
#define RIT_IRQn 29
|
||||
#define MCPWM_IRQn 30
|
||||
#define QEI_IRQn 31
|
||||
#define PLL1_IRQn 32
|
||||
#define USBACT_IRQn 33
|
||||
#define CANACT_IRQn 34
|
||||
|
||||
/* LPC176x Peripheral Divider */
|
||||
#define __set_PCLKSEL(p,v) PCLKSEL[(p) / 16] = (PCLKSEL[(p) / 16] & ~(3 << ((p) * 2 % 32))) | (v << ((p) * 2 % 32))
|
||||
#define PCLKDIV_4 0
|
||||
#define PCLKDIV_1 1
|
||||
#define PCLKDIV_2 2
|
||||
#define PCLKDIV_8 3
|
||||
#define PCLK_WDT 0
|
||||
#define PCLK_TIMER0 1
|
||||
#define PCLK_TIMER1 2
|
||||
#define PCLK_UART0 3
|
||||
#define PCLK_UART1 4
|
||||
#define PCLK_PWM1 6
|
||||
#define PCLK_I2C0 7
|
||||
#define PCLK_SPI 8
|
||||
#define PCLK_SSP1 10
|
||||
#define PCLK_DAC 11
|
||||
#define PCLK_ADC 12
|
||||
#define PCLK_CAN1 13
|
||||
#define PCLK_CAN2 14
|
||||
#define PCLK_ACF 15
|
||||
#define PCLK_QEI 16
|
||||
#define PCLK_GPIOINT 17
|
||||
#define PCLK_PCB 18
|
||||
#define PCLK_I2C1 19
|
||||
#define PCLK_SSP0 21
|
||||
#define PCLK_TIMER2 22
|
||||
#define PCLK_TIMER3 23
|
||||
#define PCLK_UART2 24
|
||||
#define PCLK_UART3 25
|
||||
#define PCLK_I2C2 26
|
||||
#define PCLK_I2S 27
|
||||
#define PCLK_RIT 28
|
||||
#define PCLK_SYSCON 29
|
||||
#define PCLK_MC 30
|
||||
|
||||
/* LPC176x Pin Configuration */
|
||||
#define __set_PINSEL(p,b,v) PINSEL[(p) * 2 + (b) / 16] = (PINSEL[(p) * 2 + (b) / 16] & ~(3 << ((b) * 2 % 32))) | (v << ((b) * 2 % 32))
|
||||
#define __set_PINMODE(p,b,v) PINMODE[(p) * 2 + (b) / 16] = (PINMODE[(p) * 2 + (b) / 16] & ~(3 << ((b) * 2 % 32))) | (v << ((b) * 2 % 32))
|
||||
#define __set_PINOD(p,b,v) PINOD[p] = (PINOD[p] & ~(1 << (b))) | ((v) << (b))
|
||||
|
||||
/* LPC176x Power Control */
|
||||
#define __set_PCONP(p,v) PCONP = (PCONP & ~(1 << (p))) | (1 << (p))
|
||||
#define PCTIM0 1
|
||||
#define PCTIM1 2
|
||||
#define PCUART0 3
|
||||
#define PCUART1 4
|
||||
#define PCPWM1 6
|
||||
#define PCIIC0 7
|
||||
#define PCSPI 8
|
||||
#define PCRTC 9
|
||||
#define PCSSP1 10
|
||||
#define PCADC 12
|
||||
#define PCCAN1 13
|
||||
#define PCCAN2 14
|
||||
#define PCGPIO 15
|
||||
#define PCRIT 16
|
||||
#define PCMCPWM 17
|
||||
#define PCQEI 18
|
||||
#define PCI2C1 19
|
||||
#define PCSSP0 21
|
||||
#define PCTIM2 22
|
||||
#define PCTIM3 23
|
||||
#define PCUART2 24
|
||||
#define PCUART3 25
|
||||
#define PCI2C2 26
|
||||
#define PCI2S 27
|
||||
#define PCGPDMA 29
|
||||
#define PCENET 30
|
||||
#define PCUSB 31
|
||||
|
||||
|
||||
/*--------------------------------------------------------------*/
|
||||
/* Misc Macros */
|
||||
/*--------------------------------------------------------------*/
|
||||
|
||||
|
||||
#define _BV(bit) (1<<(bit))
|
||||
|
||||
#define IMPORT_BIN(sect, file, sym) asm (\
|
||||
".section " #sect "\n"\
|
||||
".balign 4\n"\
|
||||
".global " #sym "\n"\
|
||||
#sym ":\n"\
|
||||
".incbin \"" file "\"\n"\
|
||||
".global _sizeof_" #sym "\n"\
|
||||
".set _sizeof_" #sym ", . - " #sym "\n"\
|
||||
".balign 4\n"\
|
||||
".section \".text\"\n")
|
||||
|
||||
#define IMPORT_BIN_PART(sect, file, ofs, siz, sym) asm (\
|
||||
".section " #sect "\n"\
|
||||
".balign 4\n"\
|
||||
".global " #sym "\n"\
|
||||
#sym ":\n"\
|
||||
".incbin \"" file "\"," #ofs "," #siz "\n"\
|
||||
".global _sizeof_" #sym "\n"\
|
||||
".set _sizeof_" #sym ", . - " #sym "\n"\
|
||||
".balign 4\n"\
|
||||
".section \".text\"\n")
|
||||
|
||||
/* Jump to secondary application */
|
||||
#define JUMP_APP(appvt) asm (\
|
||||
"LDR SP, [%0]\n" /* Initialize SP */\
|
||||
"LDR PC, [%0, #4]\n" /* Go to reset vector */\
|
||||
: : "r" (appvt))
|
||||
|
||||
|
||||
#endif /* __LPC176x */
|
|
@ -1,109 +0,0 @@
|
|||
/*-----------------------------------------------------------------------
|
||||
/ Low level disk interface modlue include file (C)ChaN, 2015
|
||||
/-----------------------------------------------------------------------*/
|
||||
|
||||
#ifndef _DISKIO_DEFINED
|
||||
#define _DISKIO_DEFINED
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
#define _DISKIO_WRITE 1 /* 1: Enable disk_write function */
|
||||
#define _DISKIO_IOCTL 1 /* 1: Enable disk_ioctl fucntion */
|
||||
#define _DISKIO_ISDIO 0 /* 1: Enable iSDIO control fucntion */
|
||||
|
||||
#include "integer.h"
|
||||
|
||||
|
||||
/* Status of Disk Functions */
|
||||
typedef BYTE DSTATUS;
|
||||
|
||||
/* Results of Disk Functions */
|
||||
typedef enum {
|
||||
RES_OK = 0, /* 0: Successful */
|
||||
RES_ERROR, /* 1: R/W Error */
|
||||
RES_WRPRT, /* 2: Write Protected */
|
||||
RES_NOTRDY, /* 3: Not Ready */
|
||||
RES_PARERR /* 4: Invalid Parameter */
|
||||
} DRESULT;
|
||||
|
||||
|
||||
#if _DISKIO_ISDIO
|
||||
/* Command structure for iSDIO ioctl command */
|
||||
typedef struct {
|
||||
BYTE func; /* Function number: 0..7 */
|
||||
WORD ndata; /* Number of bytes to transfer: 1..512, or mask + data */
|
||||
DWORD addr; /* Register address: 0..0x1FFFF */
|
||||
void* data; /* Pointer to the data (to be written | read buffer) */
|
||||
} SDIO_CMD;
|
||||
#endif
|
||||
|
||||
|
||||
/*---------------------------------------*/
|
||||
/* Prototypes for disk control functions */
|
||||
|
||||
|
||||
DSTATUS disk_initialize (BYTE pdrv);
|
||||
DSTATUS disk_status (BYTE pdrv);
|
||||
DRESULT disk_read (BYTE pdrv, BYTE* buff, DWORD sector, UINT count);
|
||||
#if _DISKIO_WRITE
|
||||
DRESULT disk_write (BYTE pdrv, const BYTE* buff, DWORD sector, UINT count);
|
||||
#endif
|
||||
#if _DISKIO_IOCTL
|
||||
DRESULT disk_ioctl (BYTE pdrv, BYTE cmd, void* buff);
|
||||
#endif
|
||||
|
||||
|
||||
/* Disk Status Bits (DSTATUS) */
|
||||
#define STA_NOINIT 0x01 /* Drive not initialized */
|
||||
#define STA_NODISK 0x02 /* No medium in the drive */
|
||||
#define STA_PROTECT 0x04 /* Write protected */
|
||||
|
||||
|
||||
/* Command code for disk_ioctrl fucntion */
|
||||
|
||||
/* Generic command (Used by FatFs) */
|
||||
#define CTRL_SYNC 0 /* Complete pending write process (needed at _FS_READONLY == 0) */
|
||||
#define GET_SECTOR_COUNT 1 /* Get media size (needed at _USE_MKFS == 1) */
|
||||
#define GET_SECTOR_SIZE 2 /* Get sector size (needed at _MAX_SS != _MIN_SS) */
|
||||
#define GET_BLOCK_SIZE 3 /* Get erase block size (needed at _USE_MKFS == 1) */
|
||||
#define CTRL_TRIM 4 /* Inform device that the data on the block of sectors is no longer used (needed at _USE_TRIM == 1) */
|
||||
|
||||
/* Generic command (Not used by FatFs) */
|
||||
#define CTRL_FORMAT 5 /* Create physical format on the media */
|
||||
#define CTRL_POWER_IDLE 6 /* Put the device idle state */
|
||||
#define CTRL_POWER_OFF 7 /* Put the device off state */
|
||||
#define CTRL_LOCK 8 /* Lock media removal */
|
||||
#define CTRL_UNLOCK 9 /* Unlock media removal */
|
||||
#define CTRL_EJECT 10 /* Eject media */
|
||||
|
||||
/* MMC/SDC specific ioctl command (Not used by FatFs) */
|
||||
#define MMC_GET_TYPE 50 /* Get card type */
|
||||
#define MMC_GET_CSD 51 /* Get CSD */
|
||||
#define MMC_GET_CID 52 /* Get CID */
|
||||
#define MMC_GET_OCR 53 /* Get OCR */
|
||||
#define MMC_GET_SDSTAT 54 /* Get SD status */
|
||||
#define ISDIO_READ 55 /* Read data form SD iSDIO register */
|
||||
#define ISDIO_WRITE 56 /* Write data to SD iSDIO register */
|
||||
#define ISDIO_MRITE 57 /* Masked write data to SD iSDIO register */
|
||||
|
||||
/* ATA/CF specific ioctl command (Not used by FatFs) */
|
||||
#define ATA_GET_REV 60 /* Get F/W revision */
|
||||
#define ATA_GET_MODEL 61 /* Get model name */
|
||||
#define ATA_GET_SN 62 /* Get serial number */
|
||||
|
||||
|
||||
/* MMC card type flags (MMC_GET_TYPE) */
|
||||
#define CT_MMC 0x01 /* MMC ver 3 */
|
||||
#define CT_SD1 0x02 /* SD ver 1 */
|
||||
#define CT_SD2 0x04 /* SD ver 2 */
|
||||
#define CT_SDC (CT_SD1|CT_SD2) /* SD */
|
||||
#define CT_BLOCK 0x08 /* Block addressing */
|
||||
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif
|
|
@ -1,6204 +0,0 @@
|
|||
/*----------------------------------------------------------------------------/
|
||||
/ FatFs - Generic FAT Filesystem Module R0.13 /
|
||||
/-----------------------------------------------------------------------------/
|
||||
/
|
||||
/ Copyright (C) 2017, ChaN, all right reserved.
|
||||
/
|
||||
/ FatFs module is an open source software. Redistribution and use of FatFs in
|
||||
/ source and binary forms, with or without modification, are permitted provided
|
||||
/ that the following condition is met:
|
||||
/
|
||||
/ 1. Redistributions of source code must retain the above copyright notice,
|
||||
/ this condition and the following disclaimer.
|
||||
/
|
||||
/ This software is provided by the copyright holder and contributors "AS IS"
|
||||
/ and any warranties related to this software are DISCLAIMED.
|
||||
/ The copyright owner or contributors be NOT LIABLE for any damages caused
|
||||
/ by use of this software.
|
||||
/
|
||||
/----------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
#include "ff.h" /* Declarations of FatFs API */
|
||||
#include "diskio.h" /* Declarations of device I/O functions */
|
||||
|
||||
|
||||
/*--------------------------------------------------------------------------
|
||||
|
||||
Module Private Definitions
|
||||
|
||||
---------------------------------------------------------------------------*/
|
||||
|
||||
#if FF_DEFINED != 87030 /* Revision ID */
|
||||
#error Wrong include file (ff.h).
|
||||
#endif
|
||||
|
||||
|
||||
/* ASCII code support macros */
|
||||
#define IsUpper(c) ((c) >= 'A' && (c) <= 'Z')
|
||||
#define IsLower(c) ((c) >= 'a' && (c) <= 'z')
|
||||
#define IsDigit(c) ((c) >= '0' && (c) <= '9')
|
||||
|
||||
|
||||
/* Additional file attribute bits for internal use */
|
||||
#define AM_VOL 0x08 /* Volume label */
|
||||
#define AM_LFN 0x0F /* LFN entry */
|
||||
#define AM_MASK 0x3F /* Mask of defined bits */
|
||||
|
||||
|
||||
/* Additional file access control and file status flags for internal use */
|
||||
#define FA_SEEKEND 0x20 /* Seek to end of the file on file open */
|
||||
#define FA_MODIFIED 0x40 /* File has been modified */
|
||||
#define FA_DIRTY 0x80 /* FIL.buf[] needs to be written-back */
|
||||
|
||||
|
||||
/* Name status flags in fn[11] */
|
||||
#define NSFLAG 11 /* Index of the name status byte */
|
||||
#define NS_LOSS 0x01 /* Out of 8.3 format */
|
||||
#define NS_LFN 0x02 /* Force to create LFN entry */
|
||||
#define NS_LAST 0x04 /* Last segment */
|
||||
#define NS_BODY 0x08 /* Lower case flag (body) */
|
||||
#define NS_EXT 0x10 /* Lower case flag (ext) */
|
||||
#define NS_DOT 0x20 /* Dot entry */
|
||||
#define NS_NOLFN 0x40 /* Do not find LFN */
|
||||
#define NS_NONAME 0x80 /* Not followed */
|
||||
|
||||
|
||||
/* Limits and boundaries */
|
||||
#define MAX_DIR 0x200000 /* Max size of FAT directory */
|
||||
#define MAX_DIR_EX 0x10000000 /* Max size of exFAT directory */
|
||||
#define MAX_FAT12 0xFF5 /* Max FAT12 clusters (differs from specs, but correct for real DOS/Windows behavior) */
|
||||
#define MAX_FAT16 0xFFF5 /* Max FAT16 clusters (differs from specs, but correct for real DOS/Windows behavior) */
|
||||
#define MAX_FAT32 0x0FFFFFF5 /* Max FAT32 clusters (not specified, practical limit) */
|
||||
#define MAX_EXFAT 0x7FFFFFFD /* Max exFAT clusters (differs from specs, implementation limit) */
|
||||
|
||||
|
||||
/* FatFs refers the FAT structure as simple byte array instead of structure member
|
||||
/ because the C structure is not binary compatible between different platforms */
|
||||
|
||||
#define BS_JmpBoot 0 /* x86 jump instruction (3-byte) */
|
||||
#define BS_OEMName 3 /* OEM name (8-byte) */
|
||||
#define BPB_BytsPerSec 11 /* Sector size [byte] (WORD) */
|
||||
#define BPB_SecPerClus 13 /* Cluster size [sector] (BYTE) */
|
||||
#define BPB_RsvdSecCnt 14 /* Size of reserved area [sector] (WORD) */
|
||||
#define BPB_NumFATs 16 /* Number of FATs (BYTE) */
|
||||
#define BPB_RootEntCnt 17 /* Size of root directory area for FAT [entry] (WORD) */
|
||||
#define BPB_TotSec16 19 /* Volume size (16-bit) [sector] (WORD) */
|
||||
#define BPB_Media 21 /* Media descriptor byte (BYTE) */
|
||||
#define BPB_FATSz16 22 /* FAT size (16-bit) [sector] (WORD) */
|
||||
#define BPB_SecPerTrk 24 /* Number of sectors per track for int13h [sector] (WORD) */
|
||||
#define BPB_NumHeads 26 /* Number of heads for int13h (WORD) */
|
||||
#define BPB_HiddSec 28 /* Volume offset from top of the drive (DWORD) */
|
||||
#define BPB_TotSec32 32 /* Volume size (32-bit) [sector] (DWORD) */
|
||||
#define BS_DrvNum 36 /* Physical drive number for int13h (BYTE) */
|
||||
#define BS_NTres 37 /* WindowsNT error flag (BYTE) */
|
||||
#define BS_BootSig 38 /* Extended boot signature (BYTE) */
|
||||
#define BS_VolID 39 /* Volume serial number (DWORD) */
|
||||
#define BS_VolLab 43 /* Volume label string (8-byte) */
|
||||
#define BS_FilSysType 54 /* Filesystem type string (8-byte) */
|
||||
#define BS_BootCode 62 /* Boot code (448-byte) */
|
||||
#define BS_55AA 510 /* Signature word (WORD) */
|
||||
|
||||
#define BPB_FATSz32 36 /* FAT32: FAT size [sector] (DWORD) */
|
||||
#define BPB_ExtFlags32 40 /* FAT32: Extended flags (WORD) */
|
||||
#define BPB_FSVer32 42 /* FAT32: Filesystem version (WORD) */
|
||||
#define BPB_RootClus32 44 /* FAT32: Root directory cluster (DWORD) */
|
||||
#define BPB_FSInfo32 48 /* FAT32: Offset of FSINFO sector (WORD) */
|
||||
#define BPB_BkBootSec32 50 /* FAT32: Offset of backup boot sector (WORD) */
|
||||
#define BS_DrvNum32 64 /* FAT32: Physical drive number for int13h (BYTE) */
|
||||
#define BS_NTres32 65 /* FAT32: Error flag (BYTE) */
|
||||
#define BS_BootSig32 66 /* FAT32: Extended boot signature (BYTE) */
|
||||
#define BS_VolID32 67 /* FAT32: Volume serial number (DWORD) */
|
||||
#define BS_VolLab32 71 /* FAT32: Volume label string (8-byte) */
|
||||
#define BS_FilSysType32 82 /* FAT32: Filesystem type string (8-byte) */
|
||||
#define BS_BootCode32 90 /* FAT32: Boot code (420-byte) */
|
||||
|
||||
#define BPB_ZeroedEx 11 /* exFAT: MBZ field (53-byte) */
|
||||
#define BPB_VolOfsEx 64 /* exFAT: Volume offset from top of the drive [sector] (QWORD) */
|
||||
#define BPB_TotSecEx 72 /* exFAT: Volume size [sector] (QWORD) */
|
||||
#define BPB_FatOfsEx 80 /* exFAT: FAT offset from top of the volume [sector] (DWORD) */
|
||||
#define BPB_FatSzEx 84 /* exFAT: FAT size [sector] (DWORD) */
|
||||
#define BPB_DataOfsEx 88 /* exFAT: Data offset from top of the volume [sector] (DWORD) */
|
||||
#define BPB_NumClusEx 92 /* exFAT: Number of clusters (DWORD) */
|
||||
#define BPB_RootClusEx 96 /* exFAT: Root directory start cluster (DWORD) */
|
||||
#define BPB_VolIDEx 100 /* exFAT: Volume serial number (DWORD) */
|
||||
#define BPB_FSVerEx 104 /* exFAT: Filesystem version (WORD) */
|
||||
#define BPB_VolFlagEx 106 /* exFAT: Volume flags (BYTE) */
|
||||
#define BPB_ActFatEx 107 /* exFAT: Active FAT flags (BYTE) */
|
||||
#define BPB_BytsPerSecEx 108 /* exFAT: Log2 of sector size in unit of byte (BYTE) */
|
||||
#define BPB_SecPerClusEx 109 /* exFAT: Log2 of cluster size in unit of sector (BYTE) */
|
||||
#define BPB_NumFATsEx 110 /* exFAT: Number of FATs (BYTE) */
|
||||
#define BPB_DrvNumEx 111 /* exFAT: Physical drive number for int13h (BYTE) */
|
||||
#define BPB_PercInUseEx 112 /* exFAT: Percent in use (BYTE) */
|
||||
#define BPB_RsvdEx 113 /* exFAT: Reserved (7-byte) */
|
||||
#define BS_BootCodeEx 120 /* exFAT: Boot code (390-byte) */
|
||||
|
||||
#define DIR_Name 0 /* Short file name (11-byte) */
|
||||
#define DIR_Attr 11 /* Attribute (BYTE) */
|
||||
#define DIR_NTres 12 /* Lower case flag (BYTE) */
|
||||
#define DIR_CrtTime10 13 /* Created time sub-second (BYTE) */
|
||||
#define DIR_CrtTime 14 /* Created time (DWORD) */
|
||||
#define DIR_LstAccDate 18 /* Last accessed date (WORD) */
|
||||
#define DIR_FstClusHI 20 /* Higher 16-bit of first cluster (WORD) */
|
||||
#define DIR_ModTime 22 /* Modified time (DWORD) */
|
||||
#define DIR_FstClusLO 26 /* Lower 16-bit of first cluster (WORD) */
|
||||
#define DIR_FileSize 28 /* File size (DWORD) */
|
||||
#define LDIR_Ord 0 /* LFN: LFN order and LLE flag (BYTE) */
|
||||
#define LDIR_Attr 11 /* LFN: LFN attribute (BYTE) */
|
||||
#define LDIR_Type 12 /* LFN: Entry type (BYTE) */
|
||||
#define LDIR_Chksum 13 /* LFN: Checksum of the SFN (BYTE) */
|
||||
#define LDIR_FstClusLO 26 /* LFN: MBZ field (WORD) */
|
||||
#define XDIR_Type 0 /* exFAT: Type of exFAT directory entry (BYTE) */
|
||||
#define XDIR_NumLabel 1 /* exFAT: Number of volume label characters (BYTE) */
|
||||
#define XDIR_Label 2 /* exFAT: Volume label (11-WORD) */
|
||||
#define XDIR_CaseSum 4 /* exFAT: Sum of case conversion table (DWORD) */
|
||||
#define XDIR_NumSec 1 /* exFAT: Number of secondary entries (BYTE) */
|
||||
#define XDIR_SetSum 2 /* exFAT: Sum of the set of directory entries (WORD) */
|
||||
#define XDIR_Attr 4 /* exFAT: File attribute (WORD) */
|
||||
#define XDIR_CrtTime 8 /* exFAT: Created time (DWORD) */
|
||||
#define XDIR_ModTime 12 /* exFAT: Modified time (DWORD) */
|
||||
#define XDIR_AccTime 16 /* exFAT: Last accessed time (DWORD) */
|
||||
#define XDIR_CrtTime10 20 /* exFAT: Created time subsecond (BYTE) */
|
||||
#define XDIR_ModTime10 21 /* exFAT: Modified time subsecond (BYTE) */
|
||||
#define XDIR_CrtTZ 22 /* exFAT: Created timezone (BYTE) */
|
||||
#define XDIR_ModTZ 23 /* exFAT: Modified timezone (BYTE) */
|
||||
#define XDIR_AccTZ 24 /* exFAT: Last accessed timezone (BYTE) */
|
||||
#define XDIR_GenFlags 33 /* exFAT: General secondary flags (BYTE) */
|
||||
#define XDIR_NumName 35 /* exFAT: Number of file name characters (BYTE) */
|
||||
#define XDIR_NameHash 36 /* exFAT: Hash of file name (WORD) */
|
||||
#define XDIR_ValidFileSize 40 /* exFAT: Valid file size (QWORD) */
|
||||
#define XDIR_FstClus 52 /* exFAT: First cluster of the file data (DWORD) */
|
||||
#define XDIR_FileSize 56 /* exFAT: File/Directory size (QWORD) */
|
||||
|
||||
#define SZDIRE 32 /* Size of a directory entry */
|
||||
#define DDEM 0xE5 /* Deleted directory entry mark set to DIR_Name[0] */
|
||||
#define RDDEM 0x05 /* Replacement of the character collides with DDEM */
|
||||
#define LLEF 0x40 /* Last long entry flag in LDIR_Ord */
|
||||
|
||||
#define FSI_LeadSig 0 /* FAT32 FSI: Leading signature (DWORD) */
|
||||
#define FSI_StrucSig 484 /* FAT32 FSI: Structure signature (DWORD) */
|
||||
#define FSI_Free_Count 488 /* FAT32 FSI: Number of free clusters (DWORD) */
|
||||
#define FSI_Nxt_Free 492 /* FAT32 FSI: Last allocated cluster (DWORD) */
|
||||
|
||||
#define MBR_Table 446 /* MBR: Offset of partition table in the MBR */
|
||||
#define SZ_PTE 16 /* MBR: Size of a partition table entry */
|
||||
#define PTE_Boot 0 /* MBR PTE: Boot indicator */
|
||||
#define PTE_StHead 1 /* MBR PTE: Start head */
|
||||
#define PTE_StSec 2 /* MBR PTE: Start sector */
|
||||
#define PTE_StCyl 3 /* MBR PTE: Start cylinder */
|
||||
#define PTE_System 4 /* MBR PTE: System ID */
|
||||
#define PTE_EdHead 5 /* MBR PTE: End head */
|
||||
#define PTE_EdSec 6 /* MBR PTE: End sector */
|
||||
#define PTE_EdCyl 7 /* MBR PTE: End cylinder */
|
||||
#define PTE_StLba 8 /* MBR PTE: Start in LBA */
|
||||
#define PTE_SizLba 12 /* MBR PTE: Size in LBA */
|
||||
|
||||
|
||||
/* Post process after fatal error on file operation */
|
||||
#define ABORT(fs, res) { fp->err = (BYTE)(res); LEAVE_FF(fs, res); }
|
||||
|
||||
|
||||
/* Reentrancy related */
|
||||
#if FF_FS_REENTRANT
|
||||
#if FF_USE_LFN == 1
|
||||
#error Static LFN work area cannot be used at thread-safe configuration
|
||||
#endif
|
||||
#define LEAVE_FF(fs, res) { unlock_fs(fs, res); return res; }
|
||||
#else
|
||||
#define LEAVE_FF(fs, res) return res
|
||||
#endif
|
||||
|
||||
|
||||
/* Definitions of volume - partition conversion */
|
||||
#if FF_MULTI_PARTITION
|
||||
#define LD2PD(vol) VolToPart[vol].pd /* Get physical drive number */
|
||||
#define LD2PT(vol) VolToPart[vol].pt /* Get partition index */
|
||||
#else
|
||||
#define LD2PD(vol) (BYTE)(vol) /* Each logical drive is bound to the same physical drive number */
|
||||
#define LD2PT(vol) 0 /* Find first valid partition or in SFD */
|
||||
#endif
|
||||
|
||||
|
||||
/* Definitions of sector size */
|
||||
#if (FF_MAX_SS < FF_MIN_SS) || (FF_MAX_SS != 512 && FF_MAX_SS != 1024 && FF_MAX_SS != 2048 && FF_MAX_SS != 4096) || (FF_MIN_SS != 512 && FF_MIN_SS != 1024 && FF_MIN_SS != 2048 && FF_MIN_SS != 4096)
|
||||
#error Wrong sector size configuration
|
||||
#endif
|
||||
#if FF_MAX_SS == FF_MIN_SS
|
||||
#define SS(fs) ((UINT)FF_MAX_SS) /* Fixed sector size */
|
||||
#else
|
||||
#define SS(fs) ((fs)->ssize) /* Variable sector size */
|
||||
#endif
|
||||
|
||||
|
||||
/* Timestamp */
|
||||
#if FF_FS_NORTC == 1
|
||||
#if FF_NORTC_YEAR < 1980 || FF_NORTC_YEAR > 2107 || FF_NORTC_MON < 1 || FF_NORTC_MON > 12 || FF_NORTC_MDAY < 1 || FF_NORTC_MDAY > 31
|
||||
#error Invalid FF_FS_NORTC settings
|
||||
#endif
|
||||
#define GET_FATTIME() ((DWORD)(FF_NORTC_YEAR - 1980) << 25 | (DWORD)FF_NORTC_MON << 21 | (DWORD)FF_NORTC_MDAY << 16)
|
||||
#else
|
||||
#define GET_FATTIME() get_fattime()
|
||||
#endif
|
||||
|
||||
|
||||
/* File lock controls */
|
||||
#if FF_FS_LOCK != 0
|
||||
#if FF_FS_READONLY
|
||||
#error FF_FS_LOCK must be 0 at read-only configuration
|
||||
#endif
|
||||
typedef struct {
|
||||
FATFS *fs; /* Object ID 1, volume (NULL:blank entry) */
|
||||
DWORD clu; /* Object ID 2, containing directory (0:root) */
|
||||
DWORD ofs; /* Object ID 3, offset in the directory */
|
||||
WORD ctr; /* Object open counter, 0:none, 0x01..0xFF:read mode open count, 0x100:write mode */
|
||||
} FILESEM;
|
||||
#endif
|
||||
|
||||
|
||||
/* SBCS up-case tables (\x80-\xFF) */
|
||||
#define TBL_CT437 {0x80,0x9A,0x45,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT720 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0xA0,0xA1,0xA2,0xA3,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT737 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0x93,0x94,0x95,0x96,0x97,0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87, \
|
||||
0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F,0x90,0x91,0xAA,0x92,0x93,0x94,0x95,0x96, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0x97,0xEA,0xEB,0xEC,0xE4,0xED,0xEE,0xEF,0xF5,0xF0,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT771 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDC,0xDE,0xDE, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0xF0,0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF8,0xFA,0xFA,0xFC,0xFC,0xFE,0xFF}
|
||||
#define TBL_CT775 {0x80,0x9A,0x91,0xA0,0x8E,0x95,0x8F,0x80,0xAD,0xED,0x8A,0x8A,0xA1,0x8D,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0xE2,0x99,0x95,0x96,0x97,0x97,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9F, \
|
||||
0xA0,0xA1,0xE0,0xA3,0xA3,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xB5,0xB6,0xB7,0xB8,0xBD,0xBE,0xC6,0xC7,0xA5,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE5,0xE5,0xE6,0xE3,0xE8,0xE8,0xEA,0xEA,0xEE,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT850 {0x43,0x55,0x45,0x41,0x41,0x41,0x41,0x43,0x45,0x45,0x45,0x49,0x49,0x49,0x41,0x41, \
|
||||
0x45,0x92,0x92,0x4F,0x4F,0x4F,0x55,0x55,0x59,0x4F,0x55,0x4F,0x9C,0x4F,0x9E,0x9F, \
|
||||
0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0x41,0x41,0x41,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0x41,0x41,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD1,0xD1,0x45,0x45,0x45,0x49,0x49,0x49,0x49,0xD9,0xDA,0xDB,0xDC,0xDD,0x49,0xDF, \
|
||||
0x4F,0xE1,0x4F,0x4F,0x4F,0x4F,0xE6,0xE8,0xE8,0x55,0x55,0x55,0x59,0x59,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT852 {0x80,0x9A,0x90,0xB6,0x8E,0xDE,0x8F,0x80,0x9D,0xD3,0x8A,0x8A,0xD7,0x8D,0x8E,0x8F, \
|
||||
0x90,0x91,0x91,0xE2,0x99,0x95,0x95,0x97,0x97,0x99,0x9A,0x9B,0x9B,0x9D,0x9E,0xAC, \
|
||||
0xB5,0xD6,0xE0,0xE9,0xA4,0xA4,0xA6,0xA6,0xA8,0xA8,0xAA,0x8D,0xAC,0xB8,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBD,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC6,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD1,0xD1,0xD2,0xD3,0xD2,0xD5,0xD6,0xD7,0xB7,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE3,0xD5,0xE6,0xE6,0xE8,0xE9,0xE8,0xEB,0xED,0xED,0xDD,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xEB,0xFC,0xFC,0xFE,0xFF}
|
||||
#define TBL_CT855 {0x81,0x81,0x83,0x83,0x85,0x85,0x87,0x87,0x89,0x89,0x8B,0x8B,0x8D,0x8D,0x8F,0x8F, \
|
||||
0x91,0x91,0x93,0x93,0x95,0x95,0x97,0x97,0x99,0x99,0x9B,0x9B,0x9D,0x9D,0x9F,0x9F, \
|
||||
0xA1,0xA1,0xA3,0xA3,0xA5,0xA5,0xA7,0xA7,0xA9,0xA9,0xAB,0xAB,0xAD,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB6,0xB6,0xB8,0xB8,0xB9,0xBA,0xBB,0xBC,0xBE,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC7,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD1,0xD1,0xD3,0xD3,0xD5,0xD5,0xD7,0xD7,0xDD,0xD9,0xDA,0xDB,0xDC,0xDD,0xE0,0xDF, \
|
||||
0xE0,0xE2,0xE2,0xE4,0xE4,0xE6,0xE6,0xE8,0xE8,0xEA,0xEA,0xEC,0xEC,0xEE,0xEE,0xEF, \
|
||||
0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF8,0xFA,0xFA,0xFC,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT857 {0x80,0x9A,0x90,0xB6,0x8E,0xB7,0x8F,0x80,0xD2,0xD3,0xD4,0xD8,0xD7,0x49,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0xE2,0x99,0xE3,0xEA,0xEB,0x98,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9E, \
|
||||
0xB5,0xD6,0xE0,0xE9,0xA5,0xA5,0xA6,0xA6,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC7,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0x49,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE5,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xDE,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT860 {0x80,0x9A,0x90,0x8F,0x8E,0x91,0x86,0x80,0x89,0x89,0x92,0x8B,0x8C,0x98,0x8E,0x8F, \
|
||||
0x90,0x91,0x92,0x8C,0x99,0xA9,0x96,0x9D,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x86,0x8B,0x9F,0x96,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT861 {0x80,0x9A,0x90,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x8B,0x8B,0x8D,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0x4F,0x99,0x8D,0x55,0x97,0x97,0x99,0x9A,0x9D,0x9C,0x9D,0x9E,0x9F, \
|
||||
0xA4,0xA5,0xA6,0xA7,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT862 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT863 {0x43,0x55,0x45,0x41,0x41,0x41,0x86,0x43,0x45,0x45,0x45,0x49,0x49,0x8D,0x41,0x8F, \
|
||||
0x45,0x45,0x45,0x4F,0x45,0x49,0x55,0x55,0x98,0x4F,0x55,0x9B,0x9C,0x55,0x55,0x9F, \
|
||||
0xA0,0xA1,0x4F,0x55,0xA4,0xA5,0xA6,0xA7,0x49,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT864 {0x80,0x9A,0x45,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT865 {0x80,0x9A,0x90,0x41,0x8E,0x41,0x8F,0x80,0x45,0x45,0x45,0x49,0x49,0x49,0x8E,0x8F, \
|
||||
0x90,0x92,0x92,0x4F,0x99,0x4F,0x55,0x55,0x59,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x41,0x49,0x4F,0x55,0xA5,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0xE0,0xE1,0xE2,0xE3,0xE4,0xE5,0xE6,0xE7,0xE8,0xE9,0xEA,0xEB,0xEC,0xED,0xEE,0xEF, \
|
||||
0xF0,0xF1,0xF2,0xF3,0xF4,0xF5,0xF6,0xF7,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT866 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xD6,0xD7,0xD8,0xD9,0xDA,0xDB,0xDC,0xDD,0xDE,0xDF, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x9B,0x9C,0x9D,0x9E,0x9F, \
|
||||
0xF0,0xF0,0xF2,0xF2,0xF4,0xF4,0xF6,0xF6,0xF8,0xF9,0xFA,0xFB,0xFC,0xFD,0xFE,0xFF}
|
||||
#define TBL_CT869 {0x80,0x81,0x82,0x83,0x84,0x85,0x86,0x87,0x88,0x89,0x8A,0x8B,0x8C,0x8D,0x8E,0x8F, \
|
||||
0x90,0x91,0x92,0x93,0x94,0x95,0x96,0x97,0x98,0x99,0x9A,0x86,0x9C,0x8D,0x8F,0x90, \
|
||||
0x91,0x90,0x92,0x95,0xA4,0xA5,0xA6,0xA7,0xA8,0xA9,0xAA,0xAB,0xAC,0xAD,0xAE,0xAF, \
|
||||
0xB0,0xB1,0xB2,0xB3,0xB4,0xB5,0xB6,0xB7,0xB8,0xB9,0xBA,0xBB,0xBC,0xBD,0xBE,0xBF, \
|
||||
0xC0,0xC1,0xC2,0xC3,0xC4,0xC5,0xC6,0xC7,0xC8,0xC9,0xCA,0xCB,0xCC,0xCD,0xCE,0xCF, \
|
||||
0xD0,0xD1,0xD2,0xD3,0xD4,0xD5,0xA4,0xA5,0xA6,0xD9,0xDA,0xDB,0xDC,0xA7,0xA8,0xDF, \
|
||||
0xA9,0xAA,0xAC,0xAD,0xB5,0xB6,0xB7,0xB8,0xBD,0xBE,0xC6,0xC7,0xCF,0xCF,0xD0,0xEF, \
|
||||
0xF0,0xF1,0xD1,0xD2,0xD3,0xF5,0xD4,0xF7,0xF8,0xF9,0xD5,0x96,0x95,0x98,0xFE,0xFF}
|
||||
|
||||
|
||||
/* DBCS code range |----- 1st byte -----| |----------- 2nd byte -----------| */
|
||||
#define TBL_DC932 {0x81, 0x9F, 0xE0, 0xFC, 0x40, 0x7E, 0x80, 0xFC, 0x00, 0x00}
|
||||
#define TBL_DC936 {0x81, 0xFE, 0x00, 0x00, 0x40, 0x7E, 0x80, 0xFE, 0x00, 0x00}
|
||||
#define TBL_DC949 {0x81, 0xFE, 0x00, 0x00, 0x41, 0x5A, 0x61, 0x7A, 0x81, 0xFE}
|
||||
#define TBL_DC950 {0x81, 0xFE, 0x00, 0x00, 0x40, 0x7E, 0xA1, 0xFE, 0x00, 0x00}
|
||||
|
||||
|
||||
/* Macros for table definitions */
|
||||
#define MERGE_2STR(a, b) a ## b
|
||||
#define MKCVTBL(hd, cp) MERGE_2STR(hd, cp)
|
||||
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------------------
|
||||
|
||||
Module Private Work Area
|
||||
|
||||
---------------------------------------------------------------------------*/
|
||||
/* Remark: Variables defined here without initial value shall be guaranteed
|
||||
/ zero/null at start-up. If not, the linker option or start-up routine is
|
||||
/ not compliance with C standard. */
|
||||
|
||||
/*--------------------------------*/
|
||||
/* File/Volume controls */
|
||||
/*--------------------------------*/
|
||||
|
||||
#if FF_VOLUMES < 1 || FF_VOLUMES > 10
|
||||
#error Wrong FF_VOLUMES setting
|
||||
#endif
|
||||
static FATFS *FatFs[FF_VOLUMES]; /* Pointer to the filesystem objects (logical drives) */
|
||||
static WORD Fsid; /* File system mount ID */
|
||||
|
||||
#if FF_FS_RPATH != 0 && FF_VOLUMES >= 2
|
||||
static BYTE CurrVol; /* Current drive */
|
||||
#endif
|
||||
|
||||
#if FF_FS_LOCK != 0
|
||||
static FILESEM Files[FF_FS_LOCK]; /* Open object lock semaphores */
|
||||
#endif
|
||||
|
||||
|
||||
/*--------------------------------*/
|
||||
/* LFN/Directory working buffer */
|
||||
/*--------------------------------*/
|
||||
|
||||
#if FF_USE_LFN == 0 /* Non-LFN configuration */
|
||||
#define DEF_NAMBUF
|
||||
#define INIT_NAMBUF(fs)
|
||||
#define FREE_NAMBUF()
|
||||
|
||||
#else /* LFN configurations */
|
||||
#if FF_MAX_LFN < 12 || FF_MAX_LFN > 255
|
||||
#error Wrong FF_MAX_LFN setting
|
||||
#endif
|
||||
static const BYTE LfnOfs[] = {1,3,5,7,9,14,16,18,20,22,24,28,30}; /* FAT: Offset of LFN characters in the directory entry */
|
||||
#define MAXDIRB(nc) ((nc + 44U) / 15 * SZDIRE) /* exFAT: Size of directory entry block scratchpad buffer needed for the max name length */
|
||||
|
||||
#if FF_USE_LFN == 1 /* LFN enabled with static working buffer */
|
||||
#if FF_FS_EXFAT
|
||||
static BYTE DirBuf[MAXDIRB(FF_MAX_LFN)]; /* Directory entry block scratchpad buffer */
|
||||
#endif
|
||||
static WCHAR LfnBuf[FF_MAX_LFN + 1]; /* LFN working buffer */
|
||||
#define DEF_NAMBUF
|
||||
#define INIT_NAMBUF(fs)
|
||||
#define FREE_NAMBUF()
|
||||
|
||||
#elif FF_USE_LFN == 2 /* LFN enabled with dynamic working buffer on the stack */
|
||||
#if FF_FS_EXFAT
|
||||
#define DEF_NAMBUF WCHAR lbuf[FF_MAX_LFN+1]; BYTE dbuf[MAXDIRB(FF_MAX_LFN)]; /* LFN working buffer and directory entry block scratchpad buffer */
|
||||
#define INIT_NAMBUF(fs) { (fs)->lfnbuf = lbuf; (fs)->dirbuf = dbuf; }
|
||||
#define FREE_NAMBUF()
|
||||
#else
|
||||
#define DEF_NAMBUF WCHAR lbuf[FF_MAX_LFN+1]; /* LFN working buffer */
|
||||
#define INIT_NAMBUF(fs) { (fs)->lfnbuf = lbuf; }
|
||||
#define FREE_NAMBUF()
|
||||
#endif
|
||||
|
||||
#elif FF_USE_LFN == 3 /* LFN enabled with dynamic working buffer on the heap */
|
||||
#if FF_FS_EXFAT
|
||||
#define DEF_NAMBUF WCHAR *lfn; /* Pointer to LFN working buffer and directory entry block scratchpad buffer */
|
||||
#define INIT_NAMBUF(fs) { lfn = ff_memalloc((FF_MAX_LFN+1)*2 + MAXDIRB(FF_MAX_LFN)); if (!lfn) LEAVE_FF(fs, FR_NOT_ENOUGH_CORE); (fs)->lfnbuf = lfn; (fs)->dirbuf = (BYTE*)(lfn+FF_MAX_LFN+1); }
|
||||
#define FREE_NAMBUF() ff_memfree(lfn)
|
||||
#else
|
||||
#define DEF_NAMBUF WCHAR *lfn; /* Pointer to LFN working buffer */
|
||||
#define INIT_NAMBUF(fs) { lfn = ff_memalloc((FF_MAX_LFN+1)*2); if (!lfn) LEAVE_FF(fs, FR_NOT_ENOUGH_CORE); (fs)->lfnbuf = lfn; }
|
||||
#define FREE_NAMBUF() ff_memfree(lfn)
|
||||
#endif
|
||||
|
||||
#else
|
||||
#error Wrong FF_USE_LFN setting
|
||||
|
||||
#endif
|
||||
#endif
|
||||
|
||||
|
||||
/*--------------------------------*/
|
||||
/* Code conversion tables */
|
||||
/*--------------------------------*/
|
||||
|
||||
#if FF_CODE_PAGE == 0 /* Run-time code page configuration */
|
||||
#define CODEPAGE CodePage
|
||||
static WORD CodePage; /* Current code page */
|
||||
static const BYTE *ExCvt, *DbcTbl; /* Pointer to current SBCS up-case table and DBCS code range table below */
|
||||
static const BYTE Ct437[] = TBL_CT437;
|
||||
static const BYTE Ct720[] = TBL_CT720;
|
||||
static const BYTE Ct737[] = TBL_CT737;
|
||||
static const BYTE Ct771[] = TBL_CT771;
|
||||
static const BYTE Ct775[] = TBL_CT775;
|
||||
static const BYTE Ct850[] = TBL_CT850;
|
||||
static const BYTE Ct852[] = TBL_CT852;
|
||||
static const BYTE Ct855[] = TBL_CT855;
|
||||
static const BYTE Ct857[] = TBL_CT857;
|
||||
static const BYTE Ct860[] = TBL_CT860;
|
||||
static const BYTE Ct861[] = TBL_CT861;
|
||||
static const BYTE Ct862[] = TBL_CT862;
|
||||
static const BYTE Ct863[] = TBL_CT863;
|
||||
static const BYTE Ct864[] = TBL_CT864;
|
||||
static const BYTE Ct865[] = TBL_CT865;
|
||||
static const BYTE Ct866[] = TBL_CT866;
|
||||
static const BYTE Ct869[] = TBL_CT869;
|
||||
static const BYTE Dc932[] = TBL_DC932;
|
||||
static const BYTE Dc936[] = TBL_DC936;
|
||||
static const BYTE Dc949[] = TBL_DC949;
|
||||
static const BYTE Dc950[] = TBL_DC950;
|
||||
|
||||
#elif FF_CODE_PAGE < 900 /* Static code page configuration (SBCS) */
|
||||
#define CODEPAGE FF_CODE_PAGE
|
||||
static const BYTE ExCvt[] = MKCVTBL(TBL_CT, FF_CODE_PAGE);
|
||||
|
||||
#else /* Static code page configuration (DBCS) */
|
||||
#define CODEPAGE FF_CODE_PAGE
|
||||
static const BYTE DbcTbl[] = MKCVTBL(TBL_DC, FF_CODE_PAGE);
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------------------
|
||||
|
||||
Module Private Functions
|
||||
|
||||
---------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Load/Store multi-byte word in the FAT structure */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
WORD ld_word (const BYTE* ptr) /* Load a 2-byte little-endian word */
|
||||
{
|
||||
WORD rv;
|
||||
|
||||
rv = ptr[1];
|
||||
rv = rv << 8 | ptr[0];
|
||||
return rv;
|
||||
}
|
||||
|
||||
static
|
||||
DWORD ld_dword (const BYTE* ptr) /* Load a 4-byte little-endian word */
|
||||
{
|
||||
DWORD rv;
|
||||
|
||||
rv = ptr[3];
|
||||
rv = rv << 8 | ptr[2];
|
||||
rv = rv << 8 | ptr[1];
|
||||
rv = rv << 8 | ptr[0];
|
||||
return rv;
|
||||
}
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
static
|
||||
QWORD ld_qword (const BYTE* ptr) /* Load an 8-byte little-endian word */
|
||||
{
|
||||
QWORD rv;
|
||||
|
||||
rv = ptr[7];
|
||||
rv = rv << 8 | ptr[6];
|
||||
rv = rv << 8 | ptr[5];
|
||||
rv = rv << 8 | ptr[4];
|
||||
rv = rv << 8 | ptr[3];
|
||||
rv = rv << 8 | ptr[2];
|
||||
rv = rv << 8 | ptr[1];
|
||||
rv = rv << 8 | ptr[0];
|
||||
return rv;
|
||||
}
|
||||
#endif
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
static
|
||||
void st_word (BYTE* ptr, WORD val) /* Store a 2-byte word in little-endian */
|
||||
{
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val;
|
||||
}
|
||||
|
||||
static
|
||||
void st_dword (BYTE* ptr, DWORD val) /* Store a 4-byte word in little-endian */
|
||||
{
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val;
|
||||
}
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
static
|
||||
void st_qword (BYTE* ptr, QWORD val) /* Store an 8-byte word in little-endian */
|
||||
{
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val; val >>= 8;
|
||||
*ptr++ = (BYTE)val;
|
||||
}
|
||||
#endif
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* String functions */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
/* Copy memory to memory */
|
||||
static
|
||||
void mem_cpy (void* dst, const void* src, UINT cnt)
|
||||
{
|
||||
BYTE *d = (BYTE*)dst;
|
||||
const BYTE *s = (const BYTE*)src;
|
||||
|
||||
if (cnt != 0) {
|
||||
do {
|
||||
*d++ = *s++;
|
||||
} while (--cnt);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/* Fill memory block */
|
||||
static
|
||||
void mem_set (void* dst, int val, UINT cnt)
|
||||
{
|
||||
BYTE *d = (BYTE*)dst;
|
||||
|
||||
do {
|
||||
*d++ = (BYTE)val;
|
||||
} while (--cnt);
|
||||
}
|
||||
|
||||
|
||||
/* Compare memory block */
|
||||
static
|
||||
int mem_cmp (const void* dst, const void* src, UINT cnt) /* ZR:same, NZ:different */
|
||||
{
|
||||
const BYTE *d = (const BYTE *)dst, *s = (const BYTE *)src;
|
||||
int r = 0;
|
||||
|
||||
do {
|
||||
r = *d++ - *s++;
|
||||
} while (--cnt && r == 0);
|
||||
|
||||
return r;
|
||||
}
|
||||
|
||||
|
||||
/* Check if chr is contained in the string */
|
||||
static
|
||||
int chk_chr (const char* str, int chr) /* NZ:contained, ZR:not contained */
|
||||
{
|
||||
while (*str && *str != chr) str++;
|
||||
return *str;
|
||||
}
|
||||
|
||||
|
||||
/* Test if the character is DBC 1st byte */
|
||||
static
|
||||
int dbc_1st (BYTE c)
|
||||
{
|
||||
#if FF_CODE_PAGE == 0 /* Variable code page */
|
||||
if (DbcTbl && c >= DbcTbl[0]) {
|
||||
if (c <= DbcTbl[1]) return 1; /* 1st byte range 1 */
|
||||
if (c >= DbcTbl[2] && c <= DbcTbl[3]) return 1; /* 1st byte range 2 */
|
||||
}
|
||||
#elif FF_CODE_PAGE >= 900 /* DBCS fixed code page */
|
||||
if (c >= DbcTbl[0]) {
|
||||
if (c <= DbcTbl[1]) return 1;
|
||||
if (c >= DbcTbl[2] && c <= DbcTbl[3]) return 1;
|
||||
}
|
||||
#else /* SBCS fixed code page */
|
||||
if (c) return 0; /* Always false */
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
/* Test if the character is DBC 2nd byte */
|
||||
static
|
||||
int dbc_2nd (BYTE c)
|
||||
{
|
||||
#if FF_CODE_PAGE == 0 /* Variable code page */
|
||||
if (DbcTbl && c >= DbcTbl[4]) {
|
||||
if (c <= DbcTbl[5]) return 1; /* 2nd byte range 1 */
|
||||
if (c >= DbcTbl[6] && c <= DbcTbl[7]) return 1; /* 2nd byte range 2 */
|
||||
if (c >= DbcTbl[8] && c <= DbcTbl[9]) return 1; /* 2nd byte range 3 */
|
||||
}
|
||||
#elif FF_CODE_PAGE >= 900 /* DBCD fixed code page */
|
||||
if (c >= DbcTbl[4]) {
|
||||
if (c <= DbcTbl[5]) return 1;
|
||||
if (c >= DbcTbl[6] && c <= DbcTbl[7]) return 1;
|
||||
if (c >= DbcTbl[8] && c <= DbcTbl[9]) return 1;
|
||||
}
|
||||
#else /* SBCS fixed code page */
|
||||
if (c) return 0; /* Always false */
|
||||
#endif
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
#if FF_FS_REENTRANT
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Request/Release grant to access the volume */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
static
|
||||
int lock_fs ( /* 1:Ok, 0:timeout */
|
||||
FATFS* fs /* Filesystem object */
|
||||
)
|
||||
{
|
||||
return ff_req_grant(fs->sobj);
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void unlock_fs (
|
||||
FATFS* fs, /* Filesystem object */
|
||||
FRESULT res /* Result code to be returned */
|
||||
)
|
||||
{
|
||||
if (fs && res != FR_NOT_ENABLED && res != FR_INVALID_DRIVE && res != FR_TIMEOUT) {
|
||||
ff_rel_grant(fs->sobj);
|
||||
}
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
#if FF_FS_LOCK != 0
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* File lock control functions */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT chk_lock ( /* Check if the file can be accessed */
|
||||
DIR* dp, /* Directory object pointing the file to be checked */
|
||||
int acc /* Desired access type (0:Read mode open, 1:Write mode open, 2:Delete or rename) */
|
||||
)
|
||||
{
|
||||
UINT i, be;
|
||||
|
||||
/* Search open object table for the object */
|
||||
be = 0;
|
||||
for (i = 0; i < FF_FS_LOCK; i++) {
|
||||
if (Files[i].fs) { /* Existing entry */
|
||||
if (Files[i].fs == dp->obj.fs && /* Check if the object matches with an open object */
|
||||
Files[i].clu == dp->obj.sclust &&
|
||||
Files[i].ofs == dp->dptr) break;
|
||||
} else { /* Blank entry */
|
||||
be = 1;
|
||||
}
|
||||
}
|
||||
if (i == FF_FS_LOCK) { /* The object has not been opened */
|
||||
return (!be && acc != 2) ? FR_TOO_MANY_OPEN_FILES : FR_OK; /* Is there a blank entry for new object? */
|
||||
}
|
||||
|
||||
/* The object was opened. Reject any open against writing file and all write mode open */
|
||||
return (acc != 0 || Files[i].ctr == 0x100) ? FR_LOCKED : FR_OK;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int enq_lock (void) /* Check if an entry is available for a new object */
|
||||
{
|
||||
UINT i;
|
||||
|
||||
for (i = 0; i < FF_FS_LOCK && Files[i].fs; i++) ;
|
||||
return (i == FF_FS_LOCK) ? 0 : 1;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
UINT inc_lock ( /* Increment object open counter and returns its index (0:Internal error) */
|
||||
DIR* dp, /* Directory object pointing the file to register or increment */
|
||||
int acc /* Desired access (0:Read, 1:Write, 2:Delete/Rename) */
|
||||
)
|
||||
{
|
||||
UINT i;
|
||||
|
||||
|
||||
for (i = 0; i < FF_FS_LOCK; i++) { /* Find the object */
|
||||
if (Files[i].fs == dp->obj.fs &&
|
||||
Files[i].clu == dp->obj.sclust &&
|
||||
Files[i].ofs == dp->dptr) break;
|
||||
}
|
||||
|
||||
if (i == FF_FS_LOCK) { /* Not opened. Register it as new. */
|
||||
for (i = 0; i < FF_FS_LOCK && Files[i].fs; i++) ;
|
||||
if (i == FF_FS_LOCK) return 0; /* No free entry to register (int err) */
|
||||
Files[i].fs = dp->obj.fs;
|
||||
Files[i].clu = dp->obj.sclust;
|
||||
Files[i].ofs = dp->dptr;
|
||||
Files[i].ctr = 0;
|
||||
}
|
||||
|
||||
if (acc && Files[i].ctr) return 0; /* Access violation (int err) */
|
||||
|
||||
Files[i].ctr = acc ? 0x100 : Files[i].ctr + 1; /* Set semaphore value */
|
||||
|
||||
return i + 1; /* Index number origin from 1 */
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
FRESULT dec_lock ( /* Decrement object open counter */
|
||||
UINT i /* Semaphore index (1..) */
|
||||
)
|
||||
{
|
||||
WORD n;
|
||||
FRESULT res;
|
||||
|
||||
|
||||
if (--i < FF_FS_LOCK) { /* Index number origin from 0 */
|
||||
n = Files[i].ctr;
|
||||
if (n == 0x100) n = 0; /* If write mode open, delete the entry */
|
||||
if (n > 0) n--; /* Decrement read mode open count */
|
||||
Files[i].ctr = n;
|
||||
if (n == 0) Files[i].fs = 0; /* Delete the entry if open count gets zero */
|
||||
res = FR_OK;
|
||||
} else {
|
||||
res = FR_INT_ERR; /* Invalid index nunber */
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void clear_lock ( /* Clear lock entries of the volume */
|
||||
FATFS *fs
|
||||
)
|
||||
{
|
||||
UINT i;
|
||||
|
||||
for (i = 0; i < FF_FS_LOCK; i++) {
|
||||
if (Files[i].fs == fs) Files[i].fs = 0;
|
||||
}
|
||||
}
|
||||
|
||||
#endif /* FF_FS_LOCK != 0 */
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Move/Flush disk access window in the filesystem object */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
#if !FF_FS_READONLY
|
||||
static
|
||||
FRESULT sync_window ( /* Returns FR_OK or FR_DISK_ERR */
|
||||
FATFS* fs /* Filesystem object */
|
||||
)
|
||||
{
|
||||
FRESULT res = FR_OK;
|
||||
|
||||
|
||||
if (fs->wflag) { /* Is the disk access window dirty */
|
||||
if (disk_write(fs->pdrv, fs->win, fs->winsect, 1) == RES_OK) { /* Write back the window */
|
||||
fs->wflag = 0; /* Clear window dirty flag */
|
||||
if (fs->winsect - fs->fatbase < fs->fsize) { /* Is it in the 1st FAT? */
|
||||
if (fs->n_fats == 2) disk_write(fs->pdrv, fs->win, fs->winsect + fs->fsize, 1); /* Reflect it to 2nd FAT if needed */
|
||||
}
|
||||
} else {
|
||||
res = FR_DISK_ERR;
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
static
|
||||
FRESULT move_window ( /* Returns FR_OK or FR_DISK_ERR */
|
||||
FATFS* fs, /* Filesystem object */
|
||||
DWORD sector /* Sector number to make appearance in the fs->win[] */
|
||||
)
|
||||
{
|
||||
FRESULT res = FR_OK;
|
||||
|
||||
|
||||
if (sector != fs->winsect) { /* Window offset changed? */
|
||||
#if !FF_FS_READONLY
|
||||
res = sync_window(fs); /* Write-back changes */
|
||||
#endif
|
||||
if (res == FR_OK) { /* Fill sector window with new data */
|
||||
if (disk_read(fs->pdrv, fs->win, sector, 1) != RES_OK) {
|
||||
sector = 0xFFFFFFFF; /* Invalidate window if read data is not valid */
|
||||
res = FR_DISK_ERR;
|
||||
}
|
||||
fs->winsect = sector;
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Synchronize filesystem and data on the storage */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT sync_fs ( /* Returns FR_OK or FR_DISK_ERR */
|
||||
FATFS* fs /* Filesystem object */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
|
||||
|
||||
res = sync_window(fs);
|
||||
if (res == FR_OK) {
|
||||
if (fs->fs_type == FS_FAT32 && fs->fsi_flag == 1) { /* FAT32: Update FSInfo sector if needed */
|
||||
/* Create FSInfo structure */
|
||||
mem_set(fs->win, 0, SS(fs));
|
||||
st_word(fs->win + BS_55AA, 0xAA55);
|
||||
st_dword(fs->win + FSI_LeadSig, 0x41615252);
|
||||
st_dword(fs->win + FSI_StrucSig, 0x61417272);
|
||||
st_dword(fs->win + FSI_Free_Count, fs->free_clst);
|
||||
st_dword(fs->win + FSI_Nxt_Free, fs->last_clst);
|
||||
/* Write it into the FSInfo sector */
|
||||
fs->winsect = fs->volbase + 1;
|
||||
disk_write(fs->pdrv, fs->win, fs->winsect, 1);
|
||||
fs->fsi_flag = 0;
|
||||
}
|
||||
/* Make sure that no pending write process in the lower layer */
|
||||
if (disk_ioctl(fs->pdrv, CTRL_SYNC, 0) != RES_OK) res = FR_DISK_ERR;
|
||||
}
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get physical sector number from cluster number */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
DWORD clst2sect ( /* !=0:Sector number, 0:Failed (invalid cluster#) */
|
||||
FATFS* fs, /* Filesystem object */
|
||||
DWORD clst /* Cluster# to be converted */
|
||||
)
|
||||
{
|
||||
clst -= 2; /* Cluster number is origin from 2 */
|
||||
if (clst >= fs->n_fatent - 2) return 0; /* Is it invalid cluster number? */
|
||||
return fs->database + fs->csize * clst; /* Start sector number of the cluster */
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT access - Read value of a FAT entry */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
DWORD get_fat ( /* 0xFFFFFFFF:Disk error, 1:Internal error, 2..0x7FFFFFFF:Cluster status */
|
||||
FFOBJID* obj, /* Corresponding object */
|
||||
DWORD clst /* Cluster number to get the value */
|
||||
)
|
||||
{
|
||||
UINT wc, bc;
|
||||
DWORD val;
|
||||
FATFS *fs = obj->fs;
|
||||
|
||||
|
||||
if (clst < 2 || clst >= fs->n_fatent) { /* Check if in valid range */
|
||||
val = 1; /* Internal error */
|
||||
|
||||
} else {
|
||||
val = 0xFFFFFFFF; /* Default value falls on disk error */
|
||||
|
||||
switch (fs->fs_type) {
|
||||
case FS_FAT12 :
|
||||
bc = (UINT)clst; bc += bc / 2;
|
||||
if (move_window(fs, fs->fatbase + (bc / SS(fs))) != FR_OK) break;
|
||||
wc = fs->win[bc++ % SS(fs)]; /* Get 1st byte of the entry */
|
||||
if (move_window(fs, fs->fatbase + (bc / SS(fs))) != FR_OK) break;
|
||||
wc |= fs->win[bc % SS(fs)] << 8; /* Merge 2nd byte of the entry */
|
||||
val = (clst & 1) ? (wc >> 4) : (wc & 0xFFF); /* Adjust bit position */
|
||||
break;
|
||||
|
||||
case FS_FAT16 :
|
||||
if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 2))) != FR_OK) break;
|
||||
val = ld_word(fs->win + clst * 2 % SS(fs)); /* Simple WORD array */
|
||||
break;
|
||||
|
||||
case FS_FAT32 :
|
||||
if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))) != FR_OK) break;
|
||||
val = ld_dword(fs->win + clst * 4 % SS(fs)) & 0x0FFFFFFF; /* Simple DWORD array but mask out upper 4 bits */
|
||||
break;
|
||||
#if FF_FS_EXFAT
|
||||
case FS_EXFAT :
|
||||
if (obj->objsize != 0) {
|
||||
DWORD cofs = clst - obj->sclust; /* Offset from start cluster */
|
||||
DWORD clen = (DWORD)((obj->objsize - 1) / SS(fs)) / fs->csize; /* Number of clusters - 1 */
|
||||
|
||||
if (obj->stat == 2 && cofs <= clen) { /* Is it a contiguous chain? */
|
||||
val = (cofs == clen) ? 0x7FFFFFFF : clst + 1; /* No data on the FAT, generate the value */
|
||||
break;
|
||||
}
|
||||
if (obj->stat == 3 && cofs < obj->n_cont) { /* Is it in the 1st fragment? */
|
||||
val = clst + 1; /* Generate the value */
|
||||
break;
|
||||
}
|
||||
if (obj->stat != 2) { /* Get value from FAT if FAT chain is valid */
|
||||
if (obj->n_frag != 0) { /* Is it on the growing edge? */
|
||||
val = 0x7FFFFFFF; /* Generate EOC */
|
||||
} else {
|
||||
if (move_window(fs, fs->fatbase + (clst / (SS(fs) / 4))) != FR_OK) break;
|
||||
val = ld_dword(fs->win + clst * 4 % SS(fs)) & 0x7FFFFFFF;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
/* go to default */
|
||||
#endif
|
||||
default:
|
||||
val = 1; /* Internal error */
|
||||
}
|
||||
}
|
||||
|
||||
return val;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT access - Change value of a FAT entry */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT put_fat ( /* FR_OK(0):succeeded, !=0:error */
|
||||
FATFS* fs, /* Corresponding filesystem object */
|
||||
DWORD clst, /* FAT index number (cluster number) to be changed */
|
||||
DWORD val /* New value to be set to the entry */
|
||||
)
|
||||
{
|
||||
UINT bc;
|
||||
BYTE *p;
|
||||
FRESULT res = FR_INT_ERR;
|
||||
|
||||
|
||||
if (clst >= 2 && clst < fs->n_fatent) { /* Check if in valid range */
|
||||
switch (fs->fs_type) {
|
||||
case FS_FAT12 :
|
||||
bc = (UINT)clst; bc += bc / 2; /* bc: byte offset of the entry */
|
||||
res = move_window(fs, fs->fatbase + (bc / SS(fs)));
|
||||
if (res != FR_OK) break;
|
||||
p = fs->win + bc++ % SS(fs);
|
||||
*p = (clst & 1) ? ((*p & 0x0F) | ((BYTE)val << 4)) : (BYTE)val; /* Put 1st byte */
|
||||
fs->wflag = 1;
|
||||
res = move_window(fs, fs->fatbase + (bc / SS(fs)));
|
||||
if (res != FR_OK) break;
|
||||
p = fs->win + bc % SS(fs);
|
||||
*p = (clst & 1) ? (BYTE)(val >> 4) : ((*p & 0xF0) | ((BYTE)(val >> 8) & 0x0F)); /* Put 2nd byte */
|
||||
fs->wflag = 1;
|
||||
break;
|
||||
|
||||
case FS_FAT16 :
|
||||
res = move_window(fs, fs->fatbase + (clst / (SS(fs) / 2)));
|
||||
if (res != FR_OK) break;
|
||||
st_word(fs->win + clst * 2 % SS(fs), (WORD)val); /* Simple WORD array */
|
||||
fs->wflag = 1;
|
||||
break;
|
||||
|
||||
case FS_FAT32 :
|
||||
#if FF_FS_EXFAT
|
||||
case FS_EXFAT :
|
||||
#endif
|
||||
res = move_window(fs, fs->fatbase + (clst / (SS(fs) / 4)));
|
||||
if (res != FR_OK) break;
|
||||
if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) {
|
||||
val = (val & 0x0FFFFFFF) | (ld_dword(fs->win + clst * 4 % SS(fs)) & 0xF0000000);
|
||||
}
|
||||
st_dword(fs->win + clst * 4 % SS(fs), val);
|
||||
fs->wflag = 1;
|
||||
break;
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
|
||||
#if FF_FS_EXFAT && !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* exFAT: Accessing FAT and Allocation Bitmap */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
/*--------------------------------------*/
|
||||
/* Find a contiguous free cluster block */
|
||||
/*--------------------------------------*/
|
||||
|
||||
static
|
||||
DWORD find_bitmap ( /* 0:Not found, 2..:Cluster block found, 0xFFFFFFFF:Disk error */
|
||||
FATFS* fs, /* Filesystem object */
|
||||
DWORD clst, /* Cluster number to scan from */
|
||||
DWORD ncl /* Number of contiguous clusters to find (1..) */
|
||||
)
|
||||
{
|
||||
BYTE bm, bv;
|
||||
UINT i;
|
||||
DWORD val, scl, ctr;
|
||||
|
||||
|
||||
clst -= 2; /* The first bit in the bitmap corresponds to cluster #2 */
|
||||
if (clst >= fs->n_fatent - 2) clst = 0;
|
||||
scl = val = clst; ctr = 0;
|
||||
for (;;) {
|
||||
if (move_window(fs, fs->database + val / 8 / SS(fs)) != FR_OK) return 0xFFFFFFFF; /* (assuming bitmap is located top of the cluster heap) */
|
||||
i = val / 8 % SS(fs); bm = 1 << (val % 8);
|
||||
do {
|
||||
do {
|
||||
bv = fs->win[i] & bm; bm <<= 1; /* Get bit value */
|
||||
if (++val >= fs->n_fatent - 2) { /* Next cluster (with wrap-around) */
|
||||
val = 0; bm = 0; i = SS(fs);
|
||||
}
|
||||
if (!bv) { /* Is it a free cluster? */
|
||||
if (++ctr == ncl) return scl + 2; /* Check if run length is sufficient for required */
|
||||
} else {
|
||||
scl = val; ctr = 0; /* Encountered a cluster in-use, restart to scan */
|
||||
}
|
||||
if (val == clst) return 0; /* All cluster scanned? */
|
||||
} while (bm);
|
||||
bm = 1;
|
||||
} while (++i < SS(fs));
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*----------------------------------------*/
|
||||
/* Set/Clear a block of allocation bitmap */
|
||||
/*----------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT change_bitmap (
|
||||
FATFS* fs, /* Filesystem object */
|
||||
DWORD clst, /* Cluster number to change from */
|
||||
DWORD ncl, /* Number of clusters to be changed */
|
||||
int bv /* bit value to be set (0 or 1) */
|
||||
)
|
||||
{
|
||||
BYTE bm;
|
||||
UINT i;
|
||||
DWORD sect;
|
||||
|
||||
|
||||
clst -= 2; /* The first bit corresponds to cluster #2 */
|
||||
sect = fs->database + clst / 8 / SS(fs); /* Sector address (assuming bitmap is located top of the cluster heap) */
|
||||
i = clst / 8 % SS(fs); /* Byte offset in the sector */
|
||||
bm = 1 << (clst % 8); /* Bit mask in the byte */
|
||||
for (;;) {
|
||||
if (move_window(fs, sect++) != FR_OK) return FR_DISK_ERR;
|
||||
do {
|
||||
do {
|
||||
if (bv == (int)((fs->win[i] & bm) != 0)) return FR_INT_ERR; /* Is the bit expected value? */
|
||||
fs->win[i] ^= bm; /* Flip the bit */
|
||||
fs->wflag = 1;
|
||||
if (--ncl == 0) return FR_OK; /* All bits processed? */
|
||||
} while (bm <<= 1); /* Next bit */
|
||||
bm = 1;
|
||||
} while (++i < SS(fs)); /* Next byte */
|
||||
i = 0;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*---------------------------------------------*/
|
||||
/* Fill the first fragment of the FAT chain */
|
||||
/*---------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT fill_first_frag (
|
||||
FFOBJID* obj /* Pointer to the corresponding object */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DWORD cl, n;
|
||||
|
||||
|
||||
if (obj->stat == 3) { /* Has the object been changed 'fragmented' in this session? */
|
||||
for (cl = obj->sclust, n = obj->n_cont; n; cl++, n--) { /* Create cluster chain on the FAT */
|
||||
res = put_fat(obj->fs, cl, cl + 1);
|
||||
if (res != FR_OK) return res;
|
||||
}
|
||||
obj->stat = 0; /* Change status 'FAT chain is valid' */
|
||||
}
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
/*---------------------------------------------*/
|
||||
/* Fill the last fragment of the FAT chain */
|
||||
/*---------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT fill_last_frag (
|
||||
FFOBJID* obj, /* Pointer to the corresponding object */
|
||||
DWORD lcl, /* Last cluster of the fragment */
|
||||
DWORD term /* Value to set the last FAT entry */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
|
||||
|
||||
while (obj->n_frag > 0) { /* Create the last chain on the FAT */
|
||||
res = put_fat(obj->fs, lcl - obj->n_frag + 1, (obj->n_frag > 1) ? lcl - obj->n_frag + 2 : term);
|
||||
if (res != FR_OK) return res;
|
||||
obj->n_frag--;
|
||||
}
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
#endif /* FF_FS_EXFAT && !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT handling - Remove a cluster chain */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
static
|
||||
FRESULT remove_chain ( /* FR_OK(0):succeeded, !=0:error */
|
||||
FFOBJID* obj, /* Corresponding object */
|
||||
DWORD clst, /* Cluster to remove a chain from */
|
||||
DWORD pclst /* Previous cluster of clst (0:entire chain) */
|
||||
)
|
||||
{
|
||||
FRESULT res = FR_OK;
|
||||
DWORD nxt;
|
||||
FATFS *fs = obj->fs;
|
||||
#if FF_FS_EXFAT || FF_USE_TRIM
|
||||
DWORD scl = clst, ecl = clst;
|
||||
#endif
|
||||
#if FF_USE_TRIM
|
||||
DWORD rt[2];
|
||||
#endif
|
||||
|
||||
if (clst < 2 || clst >= fs->n_fatent) return FR_INT_ERR; /* Check if in valid range */
|
||||
|
||||
/* Mark the previous cluster 'EOC' on the FAT if it exists */
|
||||
if (pclst != 0 && (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT || obj->stat != 2)) {
|
||||
res = put_fat(fs, pclst, 0xFFFFFFFF);
|
||||
if (res != FR_OK) return res;
|
||||
}
|
||||
|
||||
/* Remove the chain */
|
||||
do {
|
||||
nxt = get_fat(obj, clst); /* Get cluster status */
|
||||
if (nxt == 0) break; /* Empty cluster? */
|
||||
if (nxt == 1) return FR_INT_ERR; /* Internal error? */
|
||||
if (nxt == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error? */
|
||||
if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) {
|
||||
res = put_fat(fs, clst, 0); /* Mark the cluster 'free' on the FAT */
|
||||
if (res != FR_OK) return res;
|
||||
}
|
||||
if (fs->free_clst < fs->n_fatent - 2) { /* Update FSINFO */
|
||||
fs->free_clst++;
|
||||
fs->fsi_flag |= 1;
|
||||
}
|
||||
#if FF_FS_EXFAT || FF_USE_TRIM
|
||||
if (ecl + 1 == nxt) { /* Is next cluster contiguous? */
|
||||
ecl = nxt;
|
||||
} else { /* End of contiguous cluster block */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
res = change_bitmap(fs, scl, ecl - scl + 1, 0); /* Mark the cluster block 'free' on the bitmap */
|
||||
if (res != FR_OK) return res;
|
||||
}
|
||||
#endif
|
||||
#if FF_USE_TRIM
|
||||
rt[0] = clst2sect(fs, scl); /* Start of data area freed */
|
||||
rt[1] = clst2sect(fs, ecl) + fs->csize - 1; /* End of data area freed */
|
||||
disk_ioctl(fs->pdrv, CTRL_TRIM, rt); /* Inform device the data in the block is no longer needed */
|
||||
#endif
|
||||
scl = ecl = nxt;
|
||||
}
|
||||
#endif
|
||||
clst = nxt; /* Next cluster */
|
||||
} while (clst < fs->n_fatent); /* Repeat while not the last link */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
/* Some post processes for chain status */
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
if (pclst == 0) { /* Has the entire chain been removed? */
|
||||
obj->stat = 0; /* Change the chain status 'initial' */
|
||||
} else {
|
||||
if (obj->stat == 0) { /* Is it a fragmented chain from the beginning of this session? */
|
||||
clst = obj->sclust; /* Follow the chain to check if it gets contiguous */
|
||||
while (clst != pclst) {
|
||||
nxt = get_fat(obj, clst);
|
||||
if (nxt < 2) return FR_INT_ERR;
|
||||
if (nxt == 0xFFFFFFFF) return FR_DISK_ERR;
|
||||
if (nxt != clst + 1) break; /* Not contiguous? */
|
||||
clst++;
|
||||
}
|
||||
if (clst == pclst) { /* Has the chain got contiguous again? */
|
||||
obj->stat = 2; /* Change the chain status 'contiguous' */
|
||||
}
|
||||
} else {
|
||||
if (obj->stat == 3 && pclst >= obj->sclust && pclst <= obj->sclust + obj->n_cont) { /* Was the chain fragmented in this session and got contiguous again? */
|
||||
obj->stat = 2; /* Change the chain status 'contiguous' */
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT handling - Stretch a chain or Create a new chain */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
static
|
||||
DWORD create_chain ( /* 0:No free cluster, 1:Internal error, 0xFFFFFFFF:Disk error, >=2:New cluster# */
|
||||
FFOBJID* obj, /* Corresponding object */
|
||||
DWORD clst /* Cluster# to stretch, 0:Create a new chain */
|
||||
)
|
||||
{
|
||||
DWORD cs, ncl, scl;
|
||||
FRESULT res;
|
||||
FATFS *fs = obj->fs;
|
||||
|
||||
|
||||
if (clst == 0) { /* Create a new chain */
|
||||
scl = fs->last_clst; /* Suggested cluster to start to find */
|
||||
if (scl == 0 || scl >= fs->n_fatent) scl = 1;
|
||||
}
|
||||
else { /* Stretch a chain */
|
||||
cs = get_fat(obj, clst); /* Check the cluster status */
|
||||
if (cs < 2) return 1; /* Test for insanity */
|
||||
if (cs == 0xFFFFFFFF) return cs; /* Test for disk error */
|
||||
if (cs < fs->n_fatent) return cs; /* It is already followed by next cluster */
|
||||
scl = clst; /* Cluster to start to find */
|
||||
}
|
||||
if (fs->free_clst == 0) return 0; /* No free cluster */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
ncl = find_bitmap(fs, scl, 1); /* Find a free cluster */
|
||||
if (ncl == 0 || ncl == 0xFFFFFFFF) return ncl; /* No free cluster or hard error? */
|
||||
res = change_bitmap(fs, ncl, 1, 1); /* Mark the cluster 'in use' */
|
||||
if (res == FR_INT_ERR) return 1;
|
||||
if (res == FR_DISK_ERR) return 0xFFFFFFFF;
|
||||
if (clst == 0) { /* Is it a new chain? */
|
||||
obj->stat = 2; /* Set status 'contiguous' */
|
||||
} else { /* It is a stretched chain */
|
||||
if (obj->stat == 2 && ncl != scl + 1) { /* Is the chain got fragmented? */
|
||||
obj->n_cont = scl - obj->sclust; /* Set size of the contiguous part */
|
||||
obj->stat = 3; /* Change status 'just fragmented' */
|
||||
}
|
||||
}
|
||||
if (obj->stat != 2) { /* Is the file non-contiguous? */
|
||||
if (ncl == clst + 1) { /* Is the cluster next to previous one? */
|
||||
obj->n_frag = obj->n_frag ? obj->n_frag + 1 : 2; /* Increment size of last framgent */
|
||||
} else { /* New fragment */
|
||||
if (obj->n_frag == 0) obj->n_frag = 1;
|
||||
res = fill_last_frag(obj, clst, ncl); /* Fill last fragment on the FAT and link it to new one */
|
||||
if (res == FR_OK) obj->n_frag = 1;
|
||||
}
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{ /* On the FAT/FAT32 volume */
|
||||
ncl = 0;
|
||||
if (scl == clst) { /* Stretching an existing chain? */
|
||||
ncl = scl + 1; /* Test if next cluster is free */
|
||||
if (ncl >= fs->n_fatent) ncl = 2;
|
||||
cs = get_fat(obj, ncl); /* Get next cluster status */
|
||||
if (cs == 1 || cs == 0xFFFFFFFF) return cs; /* Test for error */
|
||||
if (cs != 0) { /* Not free? */
|
||||
cs = fs->last_clst; /* Start at suggested cluster if it is valid */
|
||||
if (cs >= 2 && cs < fs->n_fatent) scl = cs;
|
||||
ncl = 0;
|
||||
}
|
||||
}
|
||||
if (ncl == 0) { /* The new cluster cannot be contiguous and find another fragment */
|
||||
ncl = scl; /* Start cluster */
|
||||
for (;;) {
|
||||
ncl++; /* Next cluster */
|
||||
if (ncl >= fs->n_fatent) { /* Check wrap-around */
|
||||
ncl = 2;
|
||||
if (ncl > scl) return 0; /* No free cluster found? */
|
||||
}
|
||||
cs = get_fat(obj, ncl); /* Get the cluster status */
|
||||
if (cs == 0) break; /* Found a free cluster? */
|
||||
if (cs == 1 || cs == 0xFFFFFFFF) return cs; /* Test for error */
|
||||
if (ncl == scl) return 0; /* No free cluster found? */
|
||||
}
|
||||
}
|
||||
res = put_fat(fs, ncl, 0xFFFFFFFF); /* Mark the new cluster 'EOC' */
|
||||
if (res == FR_OK && clst != 0) {
|
||||
res = put_fat(fs, clst, ncl); /* Link it from the previous one if needed */
|
||||
}
|
||||
}
|
||||
|
||||
if (res == FR_OK) { /* Update FSINFO if function succeeded. */
|
||||
fs->last_clst = ncl;
|
||||
if (fs->free_clst <= fs->n_fatent - 2) fs->free_clst--;
|
||||
fs->fsi_flag |= 1;
|
||||
} else {
|
||||
ncl = (res == FR_DISK_ERR) ? 0xFFFFFFFF : 1; /* Failed. Generate error status */
|
||||
}
|
||||
|
||||
return ncl; /* Return new cluster number or error status */
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
|
||||
#if FF_USE_FASTSEEK
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT handling - Convert offset into cluster with link map table */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
DWORD clmt_clust ( /* <2:Error, >=2:Cluster number */
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
FSIZE_t ofs /* File offset to be converted to cluster# */
|
||||
)
|
||||
{
|
||||
DWORD cl, ncl, *tbl;
|
||||
FATFS *fs = fp->obj.fs;
|
||||
|
||||
|
||||
tbl = fp->cltbl + 1; /* Top of CLMT */
|
||||
cl = (DWORD)(ofs / SS(fs) / fs->csize); /* Cluster order from top of the file */
|
||||
for (;;) {
|
||||
ncl = *tbl++; /* Number of cluters in the fragment */
|
||||
if (ncl == 0) return 0; /* End of table? (error) */
|
||||
if (cl < ncl) break; /* In this fragment? */
|
||||
cl -= ncl; tbl++; /* Next fragment */
|
||||
}
|
||||
return cl + *tbl; /* Return the cluster number */
|
||||
}
|
||||
|
||||
#endif /* FF_USE_FASTSEEK */
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Directory handling - Fill a cluster with zeros */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
static
|
||||
FRESULT dir_clear ( /* Returns FR_OK or FR_DISK_ERR */
|
||||
FATFS *fs, /* Filesystem object */
|
||||
DWORD clst /* Directory table to clear */
|
||||
)
|
||||
{
|
||||
DWORD sect;
|
||||
UINT n, szb;
|
||||
BYTE *ibuf;
|
||||
|
||||
|
||||
if (sync_window(fs) != FR_OK) return FR_DISK_ERR; /* Flush disk access window */
|
||||
sect = clst2sect(fs, clst); /* Top of the cluster */
|
||||
fs->winsect = sect; /* Set window to top of the cluster */
|
||||
mem_set(fs->win, 0, SS(fs)); /* Clear window buffer */
|
||||
#if FF_USE_LFN == 3 /* Quick table clear by using multi-secter write */
|
||||
/* Allocate a temporary buffer (32 KB max) */
|
||||
for (szb = ((DWORD)fs->csize * SS(fs) >= 0x8000) ? 0x8000 : fs->csize * SS(fs); szb > SS(fs) && !(ibuf = ff_memalloc(szb)); szb /= 2) ;
|
||||
if (szb > SS(fs)) { /* Buffer allocated? */
|
||||
mem_set(ibuf, 0, szb);
|
||||
szb /= SS(fs); /* Bytes -> Sectors */
|
||||
for (n = 0; n < fs->csize && disk_write(fs->pdrv, ibuf, sect + n, szb) == RES_OK; n += szb) ; /* Fill the cluster with 0 */
|
||||
ff_memfree(ibuf);
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
ibuf = fs->win; szb = 1; /* Use window buffer (single-sector writes may take a time) */
|
||||
for (n = 0; n < fs->csize && disk_write(fs->pdrv, ibuf, sect + n, szb) == RES_OK; n += szb) ; /* Fill the cluster with 0 */
|
||||
}
|
||||
return (n == fs->csize) ? FR_OK : FR_DISK_ERR;
|
||||
}
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Directory handling - Set directory index */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_sdi ( /* FR_OK(0):succeeded, !=0:error */
|
||||
DIR* dp, /* Pointer to directory object */
|
||||
DWORD ofs /* Offset of directory table */
|
||||
)
|
||||
{
|
||||
DWORD csz, clst;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
|
||||
|
||||
if (ofs >= (DWORD)((FF_FS_EXFAT && fs->fs_type == FS_EXFAT) ? MAX_DIR_EX : MAX_DIR) || ofs % SZDIRE) { /* Check range of offset and alignment */
|
||||
return FR_INT_ERR;
|
||||
}
|
||||
dp->dptr = ofs; /* Set current offset */
|
||||
clst = dp->obj.sclust; /* Table start cluster (0:root) */
|
||||
if (clst == 0 && fs->fs_type >= FS_FAT32) { /* Replace cluster# 0 with root cluster# */
|
||||
clst = fs->dirbase;
|
||||
if (FF_FS_EXFAT) dp->obj.stat = 0; /* exFAT: Root dir has an FAT chain */
|
||||
}
|
||||
|
||||
if (clst == 0) { /* Static table (root-directory on the FAT volume) */
|
||||
if (ofs / SZDIRE >= fs->n_rootdir) return FR_INT_ERR; /* Is index out of range? */
|
||||
dp->sect = fs->dirbase;
|
||||
|
||||
} else { /* Dynamic table (sub-directory or root-directory on the FAT32/exFAT volume) */
|
||||
csz = (DWORD)fs->csize * SS(fs); /* Bytes per cluster */
|
||||
while (ofs >= csz) { /* Follow cluster chain */
|
||||
clst = get_fat(&dp->obj, clst); /* Get next cluster */
|
||||
if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */
|
||||
if (clst < 2 || clst >= fs->n_fatent) return FR_INT_ERR; /* Reached to end of table or internal error */
|
||||
ofs -= csz;
|
||||
}
|
||||
dp->sect = clst2sect(fs, clst);
|
||||
}
|
||||
dp->clust = clst; /* Current cluster# */
|
||||
if (dp->sect == 0) return FR_INT_ERR;
|
||||
dp->sect += ofs / SS(fs); /* Sector# of the directory entry */
|
||||
dp->dir = fs->win + (ofs % SS(fs)); /* Pointer to the entry in the win[] */
|
||||
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Directory handling - Move directory table index next */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_next ( /* FR_OK(0):succeeded, FR_NO_FILE:End of table, FR_DENIED:Could not stretch */
|
||||
DIR* dp, /* Pointer to the directory object */
|
||||
int stretch /* 0: Do not stretch table, 1: Stretch table if needed */
|
||||
)
|
||||
{
|
||||
DWORD ofs, clst;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
|
||||
|
||||
ofs = dp->dptr + SZDIRE; /* Next entry */
|
||||
if (dp->sect == 0 || ofs >= (DWORD)((FF_FS_EXFAT && fs->fs_type == FS_EXFAT) ? MAX_DIR_EX : MAX_DIR)) return FR_NO_FILE; /* Report EOT when offset has reached max value */
|
||||
|
||||
if (ofs % SS(fs) == 0) { /* Sector changed? */
|
||||
dp->sect++; /* Next sector */
|
||||
|
||||
if (dp->clust == 0) { /* Static table */
|
||||
if (ofs / SZDIRE >= fs->n_rootdir) { /* Report EOT if it reached end of static table */
|
||||
dp->sect = 0; return FR_NO_FILE;
|
||||
}
|
||||
}
|
||||
else { /* Dynamic table */
|
||||
if ((ofs / SS(fs) & (fs->csize - 1)) == 0) { /* Cluster changed? */
|
||||
clst = get_fat(&dp->obj, dp->clust); /* Get next cluster */
|
||||
if (clst <= 1) return FR_INT_ERR; /* Internal error */
|
||||
if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */
|
||||
if (clst >= fs->n_fatent) { /* It reached end of dynamic table */
|
||||
#if !FF_FS_READONLY
|
||||
if (!stretch) { /* If no stretch, report EOT */
|
||||
dp->sect = 0; return FR_NO_FILE;
|
||||
}
|
||||
clst = create_chain(&dp->obj, dp->clust); /* Allocate a cluster */
|
||||
if (clst == 0) return FR_DENIED; /* No free cluster */
|
||||
if (clst == 1) return FR_INT_ERR; /* Internal error */
|
||||
if (clst == 0xFFFFFFFF) return FR_DISK_ERR; /* Disk error */
|
||||
if (dir_clear(fs, clst) != FR_OK) return FR_DISK_ERR; /* Clean up the stretched table */
|
||||
if (FF_FS_EXFAT) dp->obj.stat |= 4; /* exFAT: The directory has been stretched */
|
||||
#else
|
||||
if (!stretch) dp->sect = 0; /* (this line is to suppress compiler warning) */
|
||||
dp->sect = 0; return FR_NO_FILE; /* Report EOT */
|
||||
#endif
|
||||
}
|
||||
dp->clust = clst; /* Initialize data for new cluster */
|
||||
dp->sect = clst2sect(fs, clst);
|
||||
}
|
||||
}
|
||||
}
|
||||
dp->dptr = ofs; /* Current entry */
|
||||
dp->dir = fs->win + ofs % SS(fs); /* Pointer to the entry in the win[] */
|
||||
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Directory handling - Reserve a block of directory entries */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_alloc ( /* FR_OK(0):succeeded, !=0:error */
|
||||
DIR* dp, /* Pointer to the directory object */
|
||||
UINT nent /* Number of contiguous entries to allocate */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
UINT n;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
|
||||
|
||||
res = dir_sdi(dp, 0);
|
||||
if (res == FR_OK) {
|
||||
n = 0;
|
||||
do {
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res != FR_OK) break;
|
||||
#if FF_FS_EXFAT
|
||||
if ((fs->fs_type == FS_EXFAT) ? (int)((dp->dir[XDIR_Type] & 0x80) == 0) : (int)(dp->dir[DIR_Name] == DDEM || dp->dir[DIR_Name] == 0)) {
|
||||
#else
|
||||
if (dp->dir[DIR_Name] == DDEM || dp->dir[DIR_Name] == 0) {
|
||||
#endif
|
||||
if (++n == nent) break; /* A block of contiguous free entries is found */
|
||||
} else {
|
||||
n = 0; /* Not a blank entry. Restart to search */
|
||||
}
|
||||
res = dir_next(dp, 1);
|
||||
} while (res == FR_OK); /* Next entry with table stretch enabled */
|
||||
}
|
||||
|
||||
if (res == FR_NO_FILE) res = FR_DENIED; /* No directory entry to allocate */
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT: Directory handling - Load/Store start cluster number */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
DWORD ld_clust ( /* Returns the top cluster value of the SFN entry */
|
||||
FATFS* fs, /* Pointer to the fs object */
|
||||
const BYTE* dir /* Pointer to the key entry */
|
||||
)
|
||||
{
|
||||
DWORD cl;
|
||||
|
||||
cl = ld_word(dir + DIR_FstClusLO);
|
||||
if (fs->fs_type == FS_FAT32) {
|
||||
cl |= (DWORD)ld_word(dir + DIR_FstClusHI) << 16;
|
||||
}
|
||||
|
||||
return cl;
|
||||
}
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
static
|
||||
void st_clust (
|
||||
FATFS* fs, /* Pointer to the fs object */
|
||||
BYTE* dir, /* Pointer to the key entry */
|
||||
DWORD cl /* Value to be set */
|
||||
)
|
||||
{
|
||||
st_word(dir + DIR_FstClusLO, (WORD)cl);
|
||||
if (fs->fs_type == FS_FAT32) {
|
||||
st_word(dir + DIR_FstClusHI, (WORD)(cl >> 16));
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
#if FF_USE_LFN
|
||||
/*--------------------------------------------------------*/
|
||||
/* FAT-LFN: Compare a part of file name with an LFN entry */
|
||||
/*--------------------------------------------------------*/
|
||||
static
|
||||
int cmp_lfn ( /* 1:matched, 0:not matched */
|
||||
const WCHAR* lfnbuf, /* Pointer to the LFN working buffer to be compared */
|
||||
BYTE* dir /* Pointer to the directory entry containing the part of LFN */
|
||||
)
|
||||
{
|
||||
UINT i, s;
|
||||
WCHAR wc, uc;
|
||||
|
||||
|
||||
if (ld_word(dir + LDIR_FstClusLO) != 0) return 0; /* Check LDIR_FstClusLO */
|
||||
|
||||
i = ((dir[LDIR_Ord] & 0x3F) - 1) * 13; /* Offset in the LFN buffer */
|
||||
|
||||
for (wc = 1, s = 0; s < 13; s++) { /* Process all characters in the entry */
|
||||
uc = ld_word(dir + LfnOfs[s]); /* Pick an LFN character */
|
||||
if (wc) {
|
||||
if (i >= FF_MAX_LFN || ff_wtoupper(uc) != ff_wtoupper(lfnbuf[i++])) { /* Compare it */
|
||||
return 0; /* Not matched */
|
||||
}
|
||||
wc = uc;
|
||||
} else {
|
||||
if (uc != 0xFFFF) return 0; /* Check filler */
|
||||
}
|
||||
}
|
||||
|
||||
if ((dir[LDIR_Ord] & LLEF) && wc && lfnbuf[i]) return 0; /* Last segment matched but different length */
|
||||
|
||||
return 1; /* The part of LFN matched */
|
||||
}
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 || FF_USE_LABEL || FF_FS_EXFAT
|
||||
/*-----------------------------------------------------*/
|
||||
/* FAT-LFN: Pick a part of file name from an LFN entry */
|
||||
/*-----------------------------------------------------*/
|
||||
static
|
||||
int pick_lfn ( /* 1:succeeded, 0:buffer overflow or invalid LFN entry */
|
||||
WCHAR* lfnbuf, /* Pointer to the LFN working buffer */
|
||||
BYTE* dir /* Pointer to the LFN entry */
|
||||
)
|
||||
{
|
||||
UINT i, s;
|
||||
WCHAR wc, uc;
|
||||
|
||||
|
||||
if (ld_word(dir + LDIR_FstClusLO) != 0) return 0; /* Check LDIR_FstClusLO is 0 */
|
||||
|
||||
i = ((dir[LDIR_Ord] & ~LLEF) - 1) * 13; /* Offset in the LFN buffer */
|
||||
|
||||
for (wc = 1, s = 0; s < 13; s++) { /* Process all characters in the entry */
|
||||
uc = ld_word(dir + LfnOfs[s]); /* Pick an LFN character */
|
||||
if (wc) {
|
||||
if (i >= FF_MAX_LFN) return 0; /* Buffer overflow? */
|
||||
lfnbuf[i++] = wc = uc; /* Store it */
|
||||
} else {
|
||||
if (uc != 0xFFFF) return 0; /* Check filler */
|
||||
}
|
||||
}
|
||||
|
||||
if (dir[LDIR_Ord] & LLEF) { /* Put terminator if it is the last LFN part */
|
||||
if (i >= FF_MAX_LFN) return 0; /* Buffer overflow? */
|
||||
lfnbuf[i] = 0;
|
||||
}
|
||||
|
||||
return 1; /* The part of LFN is valid */
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------*/
|
||||
/* FAT-LFN: Create an entry of LFN entries */
|
||||
/*-----------------------------------------*/
|
||||
static
|
||||
void put_lfn (
|
||||
const WCHAR* lfn, /* Pointer to the LFN */
|
||||
BYTE* dir, /* Pointer to the LFN entry to be created */
|
||||
BYTE ord, /* LFN order (1-20) */
|
||||
BYTE sum /* Checksum of the corresponding SFN */
|
||||
)
|
||||
{
|
||||
UINT i, s;
|
||||
WCHAR wc;
|
||||
|
||||
|
||||
dir[LDIR_Chksum] = sum; /* Set checksum */
|
||||
dir[LDIR_Attr] = AM_LFN; /* Set attribute. LFN entry */
|
||||
dir[LDIR_Type] = 0;
|
||||
st_word(dir + LDIR_FstClusLO, 0);
|
||||
|
||||
i = (ord - 1) * 13; /* Get offset in the LFN working buffer */
|
||||
s = wc = 0;
|
||||
do {
|
||||
if (wc != 0xFFFF) wc = lfn[i++]; /* Get an effective character */
|
||||
st_word(dir + LfnOfs[s], wc); /* Put it */
|
||||
if (wc == 0) wc = 0xFFFF; /* Padding characters for left locations */
|
||||
} while (++s < 13);
|
||||
if (wc == 0xFFFF || !lfn[i]) ord |= LLEF; /* Last LFN part is the start of LFN sequence */
|
||||
dir[LDIR_Ord] = ord; /* Set the LFN order */
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
#endif /* FF_USE_LFN */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_LFN && !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT-LFN: Create a Numbered SFN */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
void gen_numname (
|
||||
BYTE* dst, /* Pointer to the buffer to store numbered SFN */
|
||||
const BYTE* src, /* Pointer to SFN */
|
||||
const WCHAR* lfn, /* Pointer to LFN */
|
||||
UINT seq /* Sequence number */
|
||||
)
|
||||
{
|
||||
BYTE ns[8], c;
|
||||
UINT i, j;
|
||||
WCHAR wc;
|
||||
DWORD sr;
|
||||
|
||||
|
||||
mem_cpy(dst, src, 11);
|
||||
|
||||
if (seq > 5) { /* In case of many collisions, generate a hash number instead of sequential number */
|
||||
sr = seq;
|
||||
while (*lfn) { /* Create a CRC */
|
||||
wc = *lfn++;
|
||||
for (i = 0; i < 16; i++) {
|
||||
sr = (sr << 1) + (wc & 1);
|
||||
wc >>= 1;
|
||||
if (sr & 0x10000) sr ^= 0x11021;
|
||||
}
|
||||
}
|
||||
seq = (UINT)sr;
|
||||
}
|
||||
|
||||
/* itoa (hexdecimal) */
|
||||
i = 7;
|
||||
do {
|
||||
c = (BYTE)((seq % 16) + '0');
|
||||
if (c > '9') c += 7;
|
||||
ns[i--] = c;
|
||||
seq /= 16;
|
||||
} while (seq);
|
||||
ns[i] = '~';
|
||||
|
||||
/* Append the number to the SFN body */
|
||||
for (j = 0; j < i && dst[j] != ' '; j++) {
|
||||
if (dbc_1st(dst[j])) {
|
||||
if (j == i - 1) break;
|
||||
j++;
|
||||
}
|
||||
}
|
||||
do {
|
||||
dst[j++] = (i < 8) ? ns[i++] : ' ';
|
||||
} while (j < 8);
|
||||
}
|
||||
#endif /* FF_USE_LFN && !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_LFN
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* FAT-LFN: Calculate checksum of an SFN entry */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
BYTE sum_sfn (
|
||||
const BYTE* dir /* Pointer to the SFN entry */
|
||||
)
|
||||
{
|
||||
BYTE sum = 0;
|
||||
UINT n = 11;
|
||||
|
||||
do {
|
||||
sum = (sum >> 1) + (sum << 7) + *dir++;
|
||||
} while (--n);
|
||||
return sum;
|
||||
}
|
||||
|
||||
#endif /* FF_USE_LFN */
|
||||
|
||||
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* exFAT: Checksum */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
WORD xdir_sum ( /* Get checksum of the directoly entry block */
|
||||
const BYTE* dir /* Directory entry block to be calculated */
|
||||
)
|
||||
{
|
||||
UINT i, szblk;
|
||||
WORD sum;
|
||||
|
||||
|
||||
szblk = (dir[XDIR_NumSec] + 1) * SZDIRE;
|
||||
for (i = sum = 0; i < szblk; i++) {
|
||||
if (i == XDIR_SetSum) { /* Skip sum field */
|
||||
i++;
|
||||
} else {
|
||||
sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + dir[i];
|
||||
}
|
||||
}
|
||||
return sum;
|
||||
}
|
||||
|
||||
|
||||
|
||||
static
|
||||
WORD xname_sum ( /* Get check sum (to be used as hash) of the name */
|
||||
const WCHAR* name /* File name to be calculated */
|
||||
)
|
||||
{
|
||||
WCHAR chr;
|
||||
WORD sum = 0;
|
||||
|
||||
|
||||
while ((chr = *name++) != 0) {
|
||||
chr = ff_wtoupper(chr); /* File name needs to be upper-case converted */
|
||||
sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + (chr & 0xFF);
|
||||
sum = ((sum & 1) ? 0x8000 : 0) + (sum >> 1) + (chr >> 8);
|
||||
}
|
||||
return sum;
|
||||
}
|
||||
|
||||
|
||||
#if !FF_FS_READONLY && FF_USE_MKFS
|
||||
static
|
||||
DWORD xsum32 (
|
||||
BYTE dat, /* Byte to be calculated */
|
||||
DWORD sum /* Previous sum */
|
||||
)
|
||||
{
|
||||
sum = ((sum & 1) ? 0x80000000 : 0) + (sum >> 1) + dat;
|
||||
return sum;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2
|
||||
/*------------------------------------------------------*/
|
||||
/* exFAT: Get object information from a directory block */
|
||||
/*------------------------------------------------------*/
|
||||
|
||||
static
|
||||
void get_xdir_info (
|
||||
BYTE* dirb, /* Pointer to the direcotry entry block 85+C0+C1s */
|
||||
FILINFO* fno /* Buffer to store the extracted file information */
|
||||
)
|
||||
{
|
||||
WCHAR w;
|
||||
UINT di, si, nc;
|
||||
|
||||
/* Get file name */
|
||||
for (si = SZDIRE * 2, nc = di = 0; nc < dirb[XDIR_NumName]; si += 2, nc++) {
|
||||
if ((si % SZDIRE) == 0) si += 2; /* Skip entry type field */
|
||||
w = ld_word(dirb + si); /* Get a character */
|
||||
#if !FF_LFN_UNICODE /* ANSI/OEM API */
|
||||
w = ff_uni2oem(w, CODEPAGE); /* Convert it to OEM code */
|
||||
if (w >= 0x100) { /* Is it a double byte char? */
|
||||
fno->fname[di++] = (char)(w >> 8); /* Store 1st byte of the DBC */
|
||||
}
|
||||
#endif
|
||||
if (w == 0 || di >= FF_MAX_LFN) { di = 0; break; } /* Invalid char or buffer overflow --> inaccessible object name */
|
||||
fno->fname[di++] = (TCHAR)w; /* Store the character */
|
||||
}
|
||||
if (di == 0) fno->fname[di++] = '?'; /* Inaccessible object name? */
|
||||
fno->fname[di] = 0; /* Terminate file name */
|
||||
|
||||
fno->altname[0] = 0; /* No SFN */
|
||||
fno->fattrib = dirb[XDIR_Attr]; /* Attribute */
|
||||
fno->fsize = (fno->fattrib & AM_DIR) ? 0 : ld_qword(dirb + XDIR_FileSize); /* Size */
|
||||
fno->ftime = ld_word(dirb + XDIR_ModTime + 0); /* Time */
|
||||
fno->fdate = ld_word(dirb + XDIR_ModTime + 2); /* Date */
|
||||
}
|
||||
|
||||
#endif /* FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 */
|
||||
|
||||
|
||||
/*-----------------------------------*/
|
||||
/* exFAT: Get a directry entry block */
|
||||
/*-----------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT load_xdir ( /* FR_INT_ERR: invalid entry block */
|
||||
DIR* dp /* Reading direcotry object pointing top of the entry block to load */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
UINT i, sz_ent;
|
||||
BYTE* dirb = dp->obj.fs->dirbuf; /* Pointer to the on-memory direcotry entry block 85+C0+C1s */
|
||||
|
||||
|
||||
/* Load 85 entry */
|
||||
res = move_window(dp->obj.fs, dp->sect);
|
||||
if (res != FR_OK) return res;
|
||||
if (dp->dir[XDIR_Type] != 0x85) return FR_INT_ERR; /* Invalid order */
|
||||
mem_cpy(dirb + 0 * SZDIRE, dp->dir, SZDIRE);
|
||||
sz_ent = (dirb[XDIR_NumSec] + 1) * SZDIRE;
|
||||
if (sz_ent < 3 * SZDIRE || sz_ent > 19 * SZDIRE) return FR_INT_ERR;
|
||||
|
||||
/* Load C0 entry */
|
||||
res = dir_next(dp, 0);
|
||||
if (res == FR_NO_FILE) res = FR_INT_ERR; /* It cannot be */
|
||||
if (res != FR_OK) return res;
|
||||
res = move_window(dp->obj.fs, dp->sect);
|
||||
if (res != FR_OK) return res;
|
||||
if (dp->dir[XDIR_Type] != 0xC0) return FR_INT_ERR; /* Invalid order */
|
||||
mem_cpy(dirb + 1 * SZDIRE, dp->dir, SZDIRE);
|
||||
if (MAXDIRB(dirb[XDIR_NumName]) > sz_ent) return FR_INT_ERR;
|
||||
|
||||
/* Load C1 entries */
|
||||
i = 2 * SZDIRE; /* C1 offset to load */
|
||||
do {
|
||||
res = dir_next(dp, 0);
|
||||
if (res == FR_NO_FILE) res = FR_INT_ERR; /* It cannot be */
|
||||
if (res != FR_OK) return res;
|
||||
res = move_window(dp->obj.fs, dp->sect);
|
||||
if (res != FR_OK) return res;
|
||||
if (dp->dir[XDIR_Type] != 0xC1) return FR_INT_ERR; /* Invalid order */
|
||||
if (i < MAXDIRB(FF_MAX_LFN)) mem_cpy(dirb + i, dp->dir, SZDIRE);
|
||||
} while ((i += SZDIRE) < sz_ent);
|
||||
|
||||
/* Sanity check (do it for only accessible object) */
|
||||
if (i <= MAXDIRB(FF_MAX_LFN)) {
|
||||
if (xdir_sum(dirb) != ld_word(dirb + XDIR_SetSum)) return FR_INT_ERR;
|
||||
}
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
#if !FF_FS_READONLY || FF_FS_RPATH != 0
|
||||
/*------------------------------------------------*/
|
||||
/* exFAT: Load the object's directory entry block */
|
||||
/*------------------------------------------------*/
|
||||
static
|
||||
FRESULT load_obj_xdir (
|
||||
DIR* dp, /* Blank directory object to be used to access containing direcotry */
|
||||
const FFOBJID* obj /* Object with its containing directory information */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
|
||||
/* Open object containing directory */
|
||||
dp->obj.fs = obj->fs;
|
||||
dp->obj.sclust = obj->c_scl;
|
||||
dp->obj.stat = (BYTE)obj->c_size;
|
||||
dp->obj.objsize = obj->c_size & 0xFFFFFF00;
|
||||
dp->obj.n_frag = 0;
|
||||
dp->blk_ofs = obj->c_ofs;
|
||||
|
||||
res = dir_sdi(dp, dp->blk_ofs); /* Goto object's entry block */
|
||||
if (res == FR_OK) {
|
||||
res = load_xdir(dp); /* Load the object's entry block */
|
||||
}
|
||||
return res;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*----------------------------------------*/
|
||||
/* exFAT: Store the directory entry block */
|
||||
/*----------------------------------------*/
|
||||
static
|
||||
FRESULT store_xdir (
|
||||
DIR* dp /* Pointer to the direcotry object */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
UINT nent;
|
||||
BYTE* dirb = dp->obj.fs->dirbuf; /* Pointer to the direcotry entry block 85+C0+C1s */
|
||||
|
||||
/* Create set sum */
|
||||
st_word(dirb + XDIR_SetSum, xdir_sum(dirb));
|
||||
nent = dirb[XDIR_NumSec] + 1;
|
||||
|
||||
/* Store the direcotry entry block to the directory */
|
||||
res = dir_sdi(dp, dp->blk_ofs);
|
||||
while (res == FR_OK) {
|
||||
res = move_window(dp->obj.fs, dp->sect);
|
||||
if (res != FR_OK) break;
|
||||
mem_cpy(dp->dir, dirb, SZDIRE);
|
||||
dp->obj.fs->wflag = 1;
|
||||
if (--nent == 0) break;
|
||||
dirb += SZDIRE;
|
||||
res = dir_next(dp, 0);
|
||||
}
|
||||
return (res == FR_OK || res == FR_DISK_ERR) ? res : FR_INT_ERR;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-------------------------------------------*/
|
||||
/* exFAT: Create a new directory enrty block */
|
||||
/*-------------------------------------------*/
|
||||
|
||||
static
|
||||
void create_xdir (
|
||||
BYTE* dirb, /* Pointer to the direcotry entry block buffer */
|
||||
const WCHAR* lfn /* Pointer to the object name */
|
||||
)
|
||||
{
|
||||
UINT i;
|
||||
BYTE nc1, nlen;
|
||||
WCHAR chr;
|
||||
|
||||
|
||||
/* Create 85+C0 entry */
|
||||
mem_set(dirb, 0, 2 * SZDIRE);
|
||||
dirb[0 * SZDIRE + XDIR_Type] = 0x85;
|
||||
dirb[1 * SZDIRE + XDIR_Type] = 0xC0;
|
||||
|
||||
/* Create C1 entries */
|
||||
nlen = nc1 = 0; chr = 1; i = SZDIRE * 2;
|
||||
do {
|
||||
dirb[i++] = 0xC1; dirb[i++] = 0; /* Entry type C1 */
|
||||
do { /* Fill name field */
|
||||
if (chr && (chr = lfn[nlen]) != 0) nlen++; /* Get a character if exist */
|
||||
st_word(dirb + i, chr); /* Store it */
|
||||
i += 2;
|
||||
} while (i % SZDIRE != 0);
|
||||
nc1++;
|
||||
} while (lfn[nlen]); /* Fill next entry if any char follows */
|
||||
|
||||
dirb[XDIR_NumName] = nlen; /* Set name length */
|
||||
dirb[XDIR_NumSec] = 1 + nc1; /* Set secondary count */
|
||||
st_word(dirb + XDIR_NameHash, xname_sum(lfn)); /* Set name hash */
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
#endif /* FF_FS_EXFAT */
|
||||
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 || FF_USE_LABEL || FF_FS_EXFAT
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Read an object from the directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_read (
|
||||
DIR* dp, /* Pointer to the directory object */
|
||||
int vol /* Filtered by 0:file/directory or 1:volume label */
|
||||
)
|
||||
{
|
||||
FRESULT res = FR_NO_FILE;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
BYTE a, c;
|
||||
#if FF_USE_LFN
|
||||
BYTE ord = 0xFF, sum = 0xFF;
|
||||
#endif
|
||||
|
||||
while (dp->sect) {
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res != FR_OK) break;
|
||||
c = dp->dir[DIR_Name]; /* Test for the entry type */
|
||||
if (c == 0) {
|
||||
res = FR_NO_FILE; break; /* Reached to end of the directory */
|
||||
}
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
if (FF_USE_LABEL && vol) {
|
||||
if (c == 0x83) break; /* Volume label entry? */
|
||||
} else {
|
||||
if (c == 0x85) { /* Start of the file entry block? */
|
||||
dp->blk_ofs = dp->dptr; /* Get location of the block */
|
||||
res = load_xdir(dp); /* Load the entry block */
|
||||
if (res == FR_OK) {
|
||||
dp->obj.attr = fs->dirbuf[XDIR_Attr] & AM_MASK; /* Get attribute */
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{ /* On the FAT/FAT32 volume */
|
||||
dp->obj.attr = a = dp->dir[DIR_Attr] & AM_MASK; /* Get attribute */
|
||||
#if FF_USE_LFN /* LFN configuration */
|
||||
if (c == DDEM || c == '.' || (int)((a & ~AM_ARC) == AM_VOL) != vol) { /* An entry without valid data */
|
||||
ord = 0xFF;
|
||||
} else {
|
||||
if (a == AM_LFN) { /* An LFN entry is found */
|
||||
if (c & LLEF) { /* Is it start of an LFN sequence? */
|
||||
sum = dp->dir[LDIR_Chksum];
|
||||
c &= (BYTE)~LLEF; ord = c;
|
||||
dp->blk_ofs = dp->dptr;
|
||||
}
|
||||
/* Check LFN validity and capture it */
|
||||
ord = (c == ord && sum == dp->dir[LDIR_Chksum] && pick_lfn(fs->lfnbuf, dp->dir)) ? ord - 1 : 0xFF;
|
||||
} else { /* An SFN entry is found */
|
||||
if (ord || sum != sum_sfn(dp->dir)) { /* Is there a valid LFN? */
|
||||
dp->blk_ofs = 0xFFFFFFFF; /* It has no LFN. */
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
#else /* Non LFN configuration */
|
||||
if (c != DDEM && c != '.' && a != AM_LFN && (int)((a & ~AM_ARC) == AM_VOL) == vol) { /* Is it a valid entry? */
|
||||
break;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
res = dir_next(dp, 0); /* Next entry */
|
||||
if (res != FR_OK) break;
|
||||
}
|
||||
|
||||
if (res != FR_OK) dp->sect = 0; /* Terminate the read operation on error or EOT */
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif /* FF_FS_MINIMIZE <= 1 || FF_USE_LABEL || FF_FS_RPATH >= 2 */
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Directory handling - Find an object in the directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_find ( /* FR_OK(0):succeeded, !=0:error */
|
||||
DIR* dp /* Pointer to the directory object with the file name */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
BYTE c;
|
||||
#if FF_USE_LFN
|
||||
BYTE a, ord, sum;
|
||||
#endif
|
||||
|
||||
res = dir_sdi(dp, 0); /* Rewind directory object */
|
||||
if (res != FR_OK) return res;
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
BYTE nc;
|
||||
UINT di, ni;
|
||||
WORD hash = xname_sum(fs->lfnbuf); /* Hash value of the name to find */
|
||||
|
||||
while ((res = dir_read(dp, 0)) == FR_OK) { /* Read an item */
|
||||
#if FF_MAX_LFN < 255
|
||||
if (fs->dirbuf[XDIR_NumName] > FF_MAX_LFN) continue; /* Skip comparison if inaccessible object name */
|
||||
#endif
|
||||
if (ld_word(fs->dirbuf + XDIR_NameHash) != hash) continue; /* Skip comparison if hash mismatched */
|
||||
for (nc = fs->dirbuf[XDIR_NumName], di = SZDIRE * 2, ni = 0; nc; nc--, di += 2, ni++) { /* Compare the name */
|
||||
if ((di % SZDIRE) == 0) di += 2;
|
||||
if (ff_wtoupper(ld_word(fs->dirbuf + di)) != ff_wtoupper(fs->lfnbuf[ni])) break;
|
||||
}
|
||||
if (nc == 0 && !fs->lfnbuf[ni]) break; /* Name matched? */
|
||||
}
|
||||
return res;
|
||||
}
|
||||
#endif
|
||||
/* On the FAT/FAT32 volume */
|
||||
#if FF_USE_LFN
|
||||
ord = sum = 0xFF; dp->blk_ofs = 0xFFFFFFFF; /* Reset LFN sequence */
|
||||
#endif
|
||||
do {
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res != FR_OK) break;
|
||||
c = dp->dir[DIR_Name];
|
||||
if (c == 0) { res = FR_NO_FILE; break; } /* Reached to end of table */
|
||||
#if FF_USE_LFN /* LFN configuration */
|
||||
dp->obj.attr = a = dp->dir[DIR_Attr] & AM_MASK;
|
||||
if (c == DDEM || ((a & AM_VOL) && a != AM_LFN)) { /* An entry without valid data */
|
||||
ord = 0xFF; dp->blk_ofs = 0xFFFFFFFF; /* Reset LFN sequence */
|
||||
} else {
|
||||
if (a == AM_LFN) { /* An LFN entry is found */
|
||||
if (!(dp->fn[NSFLAG] & NS_NOLFN)) {
|
||||
if (c & LLEF) { /* Is it start of LFN sequence? */
|
||||
sum = dp->dir[LDIR_Chksum];
|
||||
c &= (BYTE)~LLEF; ord = c; /* LFN start order */
|
||||
dp->blk_ofs = dp->dptr; /* Start offset of LFN */
|
||||
}
|
||||
/* Check validity of the LFN entry and compare it with given name */
|
||||
ord = (c == ord && sum == dp->dir[LDIR_Chksum] && cmp_lfn(fs->lfnbuf, dp->dir)) ? ord - 1 : 0xFF;
|
||||
}
|
||||
} else { /* An SFN entry is found */
|
||||
if (!ord && sum == sum_sfn(dp->dir)) break; /* LFN matched? */
|
||||
if (!(dp->fn[NSFLAG] & NS_LOSS) && !mem_cmp(dp->dir, dp->fn, 11)) break; /* SFN matched? */
|
||||
ord = 0xFF; dp->blk_ofs = 0xFFFFFFFF; /* Reset LFN sequence */
|
||||
}
|
||||
}
|
||||
#else /* Non LFN configuration */
|
||||
dp->obj.attr = dp->dir[DIR_Attr] & AM_MASK;
|
||||
if (!(dp->dir[DIR_Attr] & AM_VOL) && !mem_cmp(dp->dir, dp->fn, 11)) break; /* Is it a valid entry? */
|
||||
#endif
|
||||
res = dir_next(dp, 0); /* Next entry */
|
||||
} while (res == FR_OK);
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Register an object to the directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_register ( /* FR_OK:succeeded, FR_DENIED:no free entry or too many SFN collision, FR_DISK_ERR:disk error */
|
||||
DIR* dp /* Target directory with object name to be created */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
#if FF_USE_LFN /* LFN configuration */
|
||||
UINT n, nlen, nent;
|
||||
BYTE sn[12], sum;
|
||||
|
||||
|
||||
if (dp->fn[NSFLAG] & (NS_DOT | NS_NONAME)) return FR_INVALID_NAME; /* Check name validity */
|
||||
for (nlen = 0; fs->lfnbuf[nlen]; nlen++) ; /* Get lfn length */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
nent = (nlen + 14) / 15 + 2; /* Number of entries to allocate (85+C0+C1s) */
|
||||
res = dir_alloc(dp, nent); /* Allocate entries */
|
||||
if (res != FR_OK) return res;
|
||||
dp->blk_ofs = dp->dptr - SZDIRE * (nent - 1); /* Set the allocated entry block offset */
|
||||
|
||||
if (dp->obj.stat & 4) { /* Has the directory been stretched? */
|
||||
dp->obj.stat &= ~4;
|
||||
res = fill_first_frag(&dp->obj); /* Fill the first fragment on the FAT if needed */
|
||||
if (res != FR_OK) return res;
|
||||
res = fill_last_frag(&dp->obj, dp->clust, 0xFFFFFFFF); /* Fill the last fragment on the FAT if needed */
|
||||
if (res != FR_OK) return res;
|
||||
if (dp->obj.sclust != 0) { /* Is it a sub directory? */
|
||||
DIR dj;
|
||||
|
||||
res = load_obj_xdir(&dj, &dp->obj); /* Load the object status */
|
||||
if (res != FR_OK) return res;
|
||||
dp->obj.objsize += (DWORD)fs->csize * SS(fs); /* Increase the directory size by cluster size */
|
||||
st_qword(fs->dirbuf + XDIR_FileSize, dp->obj.objsize); /* Update the allocation status */
|
||||
st_qword(fs->dirbuf + XDIR_ValidFileSize, dp->obj.objsize);
|
||||
fs->dirbuf[XDIR_GenFlags] = dp->obj.stat | 1;
|
||||
res = store_xdir(&dj); /* Store the object status */
|
||||
if (res != FR_OK) return res;
|
||||
}
|
||||
}
|
||||
|
||||
create_xdir(fs->dirbuf, fs->lfnbuf); /* Create on-memory directory block to be written later */
|
||||
return FR_OK;
|
||||
}
|
||||
#endif
|
||||
/* On the FAT/FAT32 volume */
|
||||
mem_cpy(sn, dp->fn, 12);
|
||||
if (sn[NSFLAG] & NS_LOSS) { /* When LFN is out of 8.3 format, generate a numbered name */
|
||||
dp->fn[NSFLAG] = NS_NOLFN; /* Find only SFN */
|
||||
for (n = 1; n < 100; n++) {
|
||||
gen_numname(dp->fn, sn, fs->lfnbuf, n); /* Generate a numbered name */
|
||||
res = dir_find(dp); /* Check if the name collides with existing SFN */
|
||||
if (res != FR_OK) break;
|
||||
}
|
||||
if (n == 100) return FR_DENIED; /* Abort if too many collisions */
|
||||
if (res != FR_NO_FILE) return res; /* Abort if the result is other than 'not collided' */
|
||||
dp->fn[NSFLAG] = sn[NSFLAG];
|
||||
}
|
||||
|
||||
/* Create an SFN with/without LFNs. */
|
||||
nent = (sn[NSFLAG] & NS_LFN) ? (nlen + 12) / 13 + 1 : 1; /* Number of entries to allocate */
|
||||
res = dir_alloc(dp, nent); /* Allocate entries */
|
||||
if (res == FR_OK && --nent) { /* Set LFN entry if needed */
|
||||
res = dir_sdi(dp, dp->dptr - nent * SZDIRE);
|
||||
if (res == FR_OK) {
|
||||
sum = sum_sfn(dp->fn); /* Checksum value of the SFN tied to the LFN */
|
||||
do { /* Store LFN entries in bottom first */
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res != FR_OK) break;
|
||||
put_lfn(fs->lfnbuf, dp->dir, (BYTE)nent, sum);
|
||||
fs->wflag = 1;
|
||||
res = dir_next(dp, 0); /* Next entry */
|
||||
} while (res == FR_OK && --nent);
|
||||
}
|
||||
}
|
||||
|
||||
#else /* Non LFN configuration */
|
||||
res = dir_alloc(dp, 1); /* Allocate an entry for SFN */
|
||||
|
||||
#endif
|
||||
|
||||
/* Set SFN entry */
|
||||
if (res == FR_OK) {
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res == FR_OK) {
|
||||
mem_set(dp->dir, 0, SZDIRE); /* Clean the entry */
|
||||
mem_cpy(dp->dir + DIR_Name, dp->fn, 11); /* Put SFN */
|
||||
#if FF_USE_LFN
|
||||
dp->dir[DIR_NTres] = dp->fn[NSFLAG] & (NS_BODY | NS_EXT); /* Put NT flag */
|
||||
#endif
|
||||
fs->wflag = 1;
|
||||
}
|
||||
}
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY && FF_FS_MINIMIZE == 0
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Remove an object from the directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT dir_remove ( /* FR_OK:Succeeded, FR_DISK_ERR:A disk error */
|
||||
DIR* dp /* Directory object pointing the entry to be removed */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
#if FF_USE_LFN /* LFN configuration */
|
||||
DWORD last = dp->dptr;
|
||||
|
||||
res = (dp->blk_ofs == 0xFFFFFFFF) ? FR_OK : dir_sdi(dp, dp->blk_ofs); /* Goto top of the entry block if LFN is exist */
|
||||
if (res == FR_OK) {
|
||||
do {
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res != FR_OK) break;
|
||||
/* Mark an entry 'deleted' */
|
||||
if (FF_FS_EXFAT && fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
dp->dir[XDIR_Type] &= 0x7F;
|
||||
} else { /* On the FAT/FAT32 volume */
|
||||
dp->dir[DIR_Name] = DDEM;
|
||||
}
|
||||
fs->wflag = 1;
|
||||
if (dp->dptr >= last) break; /* If reached last entry then all entries of the object has been deleted. */
|
||||
res = dir_next(dp, 0); /* Next entry */
|
||||
} while (res == FR_OK);
|
||||
if (res == FR_NO_FILE) res = FR_INT_ERR;
|
||||
}
|
||||
#else /* Non LFN configuration */
|
||||
|
||||
res = move_window(fs, dp->sect);
|
||||
if (res == FR_OK) {
|
||||
dp->dir[DIR_Name] = DDEM;
|
||||
fs->wflag = 1;
|
||||
}
|
||||
#endif
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY && FF_FS_MINIMIZE == 0 */
|
||||
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get file information from directory entry */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
void get_fileinfo ( /* No return code */
|
||||
DIR* dp, /* Pointer to the directory object */
|
||||
FILINFO* fno /* Pointer to the file information to be filled */
|
||||
)
|
||||
{
|
||||
UINT i, j;
|
||||
TCHAR c;
|
||||
DWORD tm;
|
||||
#if FF_USE_LFN
|
||||
WCHAR w, lfv;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
#endif
|
||||
|
||||
|
||||
fno->fname[0] = 0; /* Invaidate file info */
|
||||
if (dp->sect == 0) return; /* Exit if read pointer has reached end of directory */
|
||||
|
||||
#if FF_USE_LFN /* LFN configuration */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
get_xdir_info(fs->dirbuf, fno);
|
||||
return;
|
||||
} else
|
||||
#endif
|
||||
{ /* On the FAT/FAT32 volume */
|
||||
if (dp->blk_ofs != 0xFFFFFFFF) { /* Get LFN if available */
|
||||
i = j = 0;
|
||||
while ((w = fs->lfnbuf[j++]) != 0) { /* Get an LFN character */
|
||||
#if !FF_LFN_UNICODE /* ANSI/OEM API */
|
||||
w = ff_uni2oem(w, CODEPAGE); /* Unicode -> OEM */
|
||||
if (w == 0) { i = 0; break; } /* No LFN if it could not be converted */
|
||||
if (w >= 0x100) { /* Put 1st byte if it is a DBC */
|
||||
fno->fname[i++] = (char)(w >> 8);
|
||||
}
|
||||
#endif
|
||||
if (i >= FF_MAX_LFN) { i = 0; break; } /* No LFN if buffer overflow */
|
||||
fno->fname[i++] = (TCHAR)w;
|
||||
}
|
||||
fno->fname[i] = 0; /* Terminate the LFN */
|
||||
}
|
||||
}
|
||||
|
||||
i = j = 0;
|
||||
lfv = fno->fname[i]; /* LFN is exist if non-zero */
|
||||
while (i < 11) { /* Copy name body and extension */
|
||||
c = (TCHAR)dp->dir[i++];
|
||||
if (c == ' ') continue; /* Skip padding spaces */
|
||||
if (c == RDDEM) c = (TCHAR)DDEM; /* Restore replaced DDEM character */
|
||||
if (i == 9) { /* Insert a . if extension is exist */
|
||||
if (!lfv) fno->fname[j] = '.';
|
||||
fno->altname[j++] = '.';
|
||||
}
|
||||
#if FF_LFN_UNICODE /* Unicode API */
|
||||
if (dbc_1st((BYTE)c) && i != 8 && i != 11 && dbc_2nd(dp->dir[i])) {
|
||||
c = c << 8 | dp->dir[i++];
|
||||
}
|
||||
c = ff_oem2uni(c, CODEPAGE); /* OEM -> Unicode */
|
||||
if (!c) c = '?';
|
||||
#endif
|
||||
fno->altname[j] = c;
|
||||
if (!lfv) {
|
||||
if (IsUpper(c) && (dp->dir[DIR_NTres] & ((i >= 9) ? NS_EXT : NS_BODY))) {
|
||||
c += 0x20; /* To lower */
|
||||
}
|
||||
fno->fname[j] = c;
|
||||
}
|
||||
j++;
|
||||
}
|
||||
if (!lfv) {
|
||||
fno->fname[j] = 0;
|
||||
if (!dp->dir[DIR_NTres]) j = 0; /* Altname is no longer needed if neither LFN nor case info is exist. */
|
||||
}
|
||||
fno->altname[j] = 0; /* Terminate the SFN */
|
||||
|
||||
#else /* Non-LFN configuration */
|
||||
i = j = 0;
|
||||
while (i < 11) { /* Copy name body and extension */
|
||||
c = (TCHAR)dp->dir[i++];
|
||||
if (c == ' ') continue; /* Skip padding spaces */
|
||||
if (c == RDDEM) c = (TCHAR)DDEM; /* Restore replaced DDEM character */
|
||||
if (i == 9) fno->fname[j++] = '.'; /* Insert a . if extension is exist */
|
||||
fno->fname[j++] = c;
|
||||
}
|
||||
fno->fname[j] = 0;
|
||||
#endif
|
||||
|
||||
fno->fattrib = dp->dir[DIR_Attr]; /* Attribute */
|
||||
fno->fsize = ld_dword(dp->dir + DIR_FileSize); /* Size */
|
||||
tm = ld_dword(dp->dir + DIR_ModTime); /* Timestamp */
|
||||
fno->ftime = (WORD)tm; fno->fdate = (WORD)(tm >> 16);
|
||||
}
|
||||
|
||||
#endif /* FF_FS_MINIMIZE <= 1 || FF_FS_RPATH >= 2 */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_FIND && FF_FS_MINIMIZE <= 1
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Pattern matching */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
WCHAR get_achar ( /* Get a character and advances ptr 1 or 2 */
|
||||
const TCHAR** ptr /* Pointer to pointer to the SBCS/DBCS/Unicode string */
|
||||
)
|
||||
{
|
||||
WCHAR chr;
|
||||
|
||||
#if FF_LFN_UNICODE && FF_USE_LFN /* Unicode API */
|
||||
chr = ff_wtoupper(*(*ptr)++); /* Get a Unicode char and to upper */
|
||||
#else /* ANSI/OEM API */
|
||||
chr = (BYTE)*(*ptr)++; /* Get a byte */
|
||||
if (IsLower(chr)) chr -= 0x20; /* To upper ASCII char */
|
||||
#if FF_CODE_PAGE == 0
|
||||
if (ExCvt && chr >= 0x80) chr = ExCvt[chr - 0x80]; /* To upper SBCS extended char */
|
||||
#elif FF_CODE_PAGE < 900
|
||||
if (chr >= 0x80) chr = ExCvt[chr - 0x80]; /* To upper SBCS extended char */
|
||||
#endif
|
||||
#if FF_CODE_PAGE == 0 || FF_CODE_PAGE >= 900
|
||||
if (dbc_1st((BYTE)chr) && dbc_2nd((BYTE)**ptr)) { /* Get DBC 2nd byte if needed */
|
||||
chr = chr << 8 | (BYTE)*(*ptr)++;
|
||||
}
|
||||
#endif
|
||||
#endif
|
||||
return chr;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int pattern_matching ( /* 0:not matched, 1:matched */
|
||||
const TCHAR* pat, /* Matching pattern */
|
||||
const TCHAR* nam, /* String to be tested */
|
||||
int skip, /* Number of pre-skip chars (number of ?s) */
|
||||
int inf /* Infinite search (* specified) */
|
||||
)
|
||||
{
|
||||
const TCHAR *pp, *np;
|
||||
WCHAR pc, nc;
|
||||
int nm, nx;
|
||||
|
||||
|
||||
while (skip--) { /* Pre-skip name chars */
|
||||
if (!get_achar(&nam)) return 0; /* Branch mismatched if less name chars */
|
||||
}
|
||||
if (!*pat && inf) return 1; /* (short circuit) */
|
||||
|
||||
do {
|
||||
pp = pat; np = nam; /* Top of pattern and name to match */
|
||||
for (;;) {
|
||||
if (*pp == '?' || *pp == '*') { /* Wildcard? */
|
||||
nm = nx = 0;
|
||||
do { /* Analyze the wildcard chars */
|
||||
if (*pp++ == '?') nm++; else nx = 1;
|
||||
} while (*pp == '?' || *pp == '*');
|
||||
if (pattern_matching(pp, np, nm, nx)) return 1; /* Test new branch (recurs upto number of wildcard blocks in the pattern) */
|
||||
nc = *np; break; /* Branch mismatched */
|
||||
}
|
||||
pc = get_achar(&pp); /* Get a pattern char */
|
||||
nc = get_achar(&np); /* Get a name char */
|
||||
if (pc != nc) break; /* Branch mismatched? */
|
||||
if (pc == 0) return 1; /* Branch matched? (matched at end of both strings) */
|
||||
}
|
||||
get_achar(&nam); /* nam++ */
|
||||
} while (inf && nc); /* Retry until end of name if infinite search is specified */
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#endif /* FF_USE_FIND && FF_FS_MINIMIZE <= 1 */
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Pick a top segment and create the object name in directory form */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT create_name ( /* FR_OK: successful, FR_INVALID_NAME: could not create */
|
||||
DIR* dp, /* Pointer to the directory object */
|
||||
const TCHAR** path /* Pointer to pointer to the segment in the path string */
|
||||
)
|
||||
{
|
||||
#if FF_USE_LFN /* LFN configuration */
|
||||
BYTE b, cf;
|
||||
WCHAR w, *lfn;
|
||||
UINT i, ni, si, di;
|
||||
const TCHAR *p;
|
||||
|
||||
|
||||
/* Create LFN in Unicode */
|
||||
p = *path; lfn = dp->obj.fs->lfnbuf; si = di = 0;
|
||||
for (;;) {
|
||||
w = p[si++]; /* Get a character */
|
||||
if (w < ' ') break; /* Break if end of the path name */
|
||||
if (w == '/' || w == '\\') { /* Break if a separator is found */
|
||||
while (p[si] == '/' || p[si] == '\\') si++; /* Skip duplicated separator if exist */
|
||||
break;
|
||||
}
|
||||
if (di >= FF_MAX_LFN) return FR_INVALID_NAME; /* Reject too long name */
|
||||
#if !FF_LFN_UNICODE /* ANSI/OEM API */
|
||||
w &= 0xFF;
|
||||
if (dbc_1st((BYTE)w)) { /* Check if it is a DBC 1st byte */
|
||||
b = (BYTE)p[si++]; /* Get 2nd byte */
|
||||
w = (w << 8) + b; /* Create a DBC */
|
||||
if (!dbc_2nd(b)) return FR_INVALID_NAME; /* Reject invalid sequence */
|
||||
}
|
||||
w = ff_oem2uni(w, CODEPAGE); /* Convert ANSI/OEM to Unicode */
|
||||
if (!w) return FR_INVALID_NAME; /* Reject invalid code */
|
||||
#endif
|
||||
if (w < 0x80 && chk_chr("\"*:<>\?|\x7F", w)) return FR_INVALID_NAME; /* Reject illegal characters for LFN */
|
||||
lfn[di++] = w; /* Store the Unicode character */
|
||||
}
|
||||
*path = &p[si]; /* Return pointer to the next segment */
|
||||
cf = (w < ' ') ? NS_LAST : 0; /* Set last segment flag if end of the path */
|
||||
#if FF_FS_RPATH != 0
|
||||
if ((di == 1 && lfn[di - 1] == '.') ||
|
||||
(di == 2 && lfn[di - 1] == '.' && lfn[di - 2] == '.')) { /* Is this segment a dot name? */
|
||||
lfn[di] = 0;
|
||||
for (i = 0; i < 11; i++) /* Create dot name for SFN entry */
|
||||
dp->fn[i] = (i < di) ? '.' : ' ';
|
||||
dp->fn[i] = cf | NS_DOT; /* This is a dot entry */
|
||||
return FR_OK;
|
||||
}
|
||||
#endif
|
||||
while (di) { /* Snip off trailing spaces and dots if exist */
|
||||
w = lfn[di - 1];
|
||||
if (w != ' ' && w != '.') break;
|
||||
di--;
|
||||
}
|
||||
lfn[di] = 0; /* LFN is created */
|
||||
if (di == 0) return FR_INVALID_NAME; /* Reject nul name */
|
||||
|
||||
/* Create SFN in directory form */
|
||||
mem_set(dp->fn, ' ', 11);
|
||||
for (si = 0; lfn[si] == ' ' || lfn[si] == '.'; si++) ; /* Strip leading spaces and dots */
|
||||
if (si > 0) cf |= NS_LOSS | NS_LFN;
|
||||
while (di > 0 && lfn[di - 1] != '.') di--; /* Find extension (di<=si: no extension) */
|
||||
|
||||
i = b = 0; ni = 8;
|
||||
for (;;) {
|
||||
w = lfn[si++]; /* Get an LFN character */
|
||||
if (!w) break; /* Break on end of the LFN */
|
||||
if (w == ' ' || (w == '.' && si != di)) { /* Remove spaces and dots */
|
||||
cf |= NS_LOSS | NS_LFN;
|
||||
continue;
|
||||
}
|
||||
|
||||
if (i >= ni || si == di) { /* Entered extension or end of SFN */
|
||||
if (ni == 11) { /* Extension fileld overflow? */
|
||||
cf |= NS_LOSS | NS_LFN;
|
||||
break;
|
||||
}
|
||||
if (si != di) cf |= NS_LOSS | NS_LFN; /* Out of 8.3 format */
|
||||
if (si > di) break; /* No extension */
|
||||
si = di; i = 8; ni = 11; /* Enter extension fileld */
|
||||
b <<= 2; continue;
|
||||
}
|
||||
|
||||
if (w >= 0x80) { /* Is this a non-ASCII character? */
|
||||
cf |= NS_LFN; /* Force to create LFN entry */
|
||||
#if FF_CODE_PAGE == 0
|
||||
if (ExCvt) { /* In SBCS */
|
||||
w = ff_uni2oem(w, CODEPAGE); /* Unicode -> OEM code */
|
||||
if (w & 0x80) w = ExCvt[w & 0x7F]; /* Convert extended character to upper (SBCS) */
|
||||
} else { /* In DBCS */
|
||||
w = ff_uni2oem(ff_wtoupper(w), CODEPAGE); /* Upper converted Unicode -> OEM code */
|
||||
}
|
||||
#elif FF_CODE_PAGE < 900 /* SBCS cfg */
|
||||
w = ff_uni2oem(w, CODEPAGE); /* Unicode -> OEM code */
|
||||
if (w & 0x80) w = ExCvt[w & 0x7F]; /* Convert extended character to upper (SBCS) */
|
||||
#else /* DBCS cfg */
|
||||
w = ff_uni2oem(ff_wtoupper(w), CODEPAGE); /* Upper converted Unicode -> OEM code */
|
||||
#endif
|
||||
}
|
||||
|
||||
if (w >= 0x100) { /* Is this a DBC? */
|
||||
if (i >= ni - 1) { /* Field overflow? */
|
||||
cf |= NS_LOSS | NS_LFN;
|
||||
i = ni; continue; /* Next field */
|
||||
}
|
||||
dp->fn[i++] = (BYTE)(w >> 8); /* Put 1st byte */
|
||||
} else { /* SBC */
|
||||
if (!w || chk_chr("+,;=[]", w)) { /* Replace illegal characters for SFN */
|
||||
w = '_'; cf |= NS_LOSS | NS_LFN;/* Lossy conversion */
|
||||
} else {
|
||||
if (IsUpper(w)) { /* ASCII large capital */
|
||||
b |= 2;
|
||||
} else {
|
||||
if (IsLower(w)) { /* ASCII small capital */
|
||||
b |= 1; w -= 0x20;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
dp->fn[i++] = (BYTE)w;
|
||||
}
|
||||
|
||||
if (dp->fn[0] == DDEM) dp->fn[0] = RDDEM; /* If the first character collides with DDEM, replace it with RDDEM */
|
||||
|
||||
if (ni == 8) b <<= 2;
|
||||
if ((b & 0x0C) == 0x0C || (b & 0x03) == 0x03) cf |= NS_LFN; /* Create LFN entry when there are composite capitals */
|
||||
if (!(cf & NS_LFN)) { /* When LFN is in 8.3 format without extended character, NT flags are created */
|
||||
if ((b & 0x03) == 0x01) cf |= NS_EXT; /* NT flag (Extension has only small capital) */
|
||||
if ((b & 0x0C) == 0x04) cf |= NS_BODY; /* NT flag (Filename has only small capital) */
|
||||
}
|
||||
|
||||
dp->fn[NSFLAG] = cf; /* SFN is created */
|
||||
|
||||
return FR_OK;
|
||||
|
||||
|
||||
#else /* FF_USE_LFN : Non-LFN configuration */
|
||||
BYTE c, d, *sfn;
|
||||
UINT ni, si, i;
|
||||
const char *p;
|
||||
|
||||
/* Create file name in directory form */
|
||||
p = *path; sfn = dp->fn;
|
||||
mem_set(sfn, ' ', 11);
|
||||
si = i = 0; ni = 8;
|
||||
#if FF_FS_RPATH != 0
|
||||
if (p[si] == '.') { /* Is this a dot entry? */
|
||||
for (;;) {
|
||||
c = (BYTE)p[si++];
|
||||
if (c != '.' || si >= 3) break;
|
||||
sfn[i++] = c;
|
||||
}
|
||||
if (c != '/' && c != '\\' && c > ' ') return FR_INVALID_NAME;
|
||||
*path = p + si; /* Return pointer to the next segment */
|
||||
sfn[NSFLAG] = (c <= ' ') ? NS_LAST | NS_DOT : NS_DOT; /* Set last segment flag if end of the path */
|
||||
return FR_OK;
|
||||
}
|
||||
#endif
|
||||
for (;;) {
|
||||
c = (BYTE)p[si++];
|
||||
if (c <= ' ') break; /* Break if end of the path name */
|
||||
if (c == '/' || c == '\\') { /* Break if a separator is found */
|
||||
while (p[si] == '/' || p[si] == '\\') si++; /* Skip duplicated separator if exist */
|
||||
break;
|
||||
}
|
||||
if (c == '.' || i >= ni) { /* End of body or over size? */
|
||||
if (ni == 11 || c != '.') return FR_INVALID_NAME; /* Over size or invalid dot */
|
||||
i = 8; ni = 11; /* Goto extension */
|
||||
continue;
|
||||
}
|
||||
#if FF_CODE_PAGE == 0
|
||||
if (ExCvt && c >= 0x80) { /* Is SBC extended character? */
|
||||
c = ExCvt[c - 0x80]; /* To upper SBC extended character */
|
||||
}
|
||||
#elif FF_CODE_PAGE < 900
|
||||
if (c >= 0x80) { /* Is SBC extended character? */
|
||||
c = ExCvt[c - 0x80]; /* To upper SBC extended character */
|
||||
}
|
||||
#endif
|
||||
if (dbc_1st(c)) { /* Check if it is a DBC 1st byte */
|
||||
d = (BYTE)p[si++]; /* Get 2nd byte */
|
||||
if (!dbc_2nd(d) || i >= ni - 1) return FR_INVALID_NAME; /* Reject invalid DBC */
|
||||
sfn[i++] = c;
|
||||
sfn[i++] = d;
|
||||
} else { /* SBC */
|
||||
if (chk_chr("\"*+,:;<=>\?[]|\x7F", c)) return FR_INVALID_NAME; /* Reject illegal chrs for SFN */
|
||||
if (IsLower(c)) c -= 0x20; /* To upper */
|
||||
sfn[i++] = c;
|
||||
}
|
||||
}
|
||||
*path = p + si; /* Return pointer to the next segment */
|
||||
if (i == 0) return FR_INVALID_NAME; /* Reject nul string */
|
||||
|
||||
if (sfn[0] == DDEM) sfn[0] = RDDEM; /* If the first character collides with DDEM, replace it with RDDEM */
|
||||
sfn[NSFLAG] = (c <= ' ') ? NS_LAST : 0; /* Set last segment flag if end of the path */
|
||||
|
||||
return FR_OK;
|
||||
#endif /* FF_USE_LFN */
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Follow a file path */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT follow_path ( /* FR_OK(0): successful, !=0: error code */
|
||||
DIR* dp, /* Directory object to return last directory and found object */
|
||||
const TCHAR* path /* Full-path string to find a file or directory */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
BYTE ns;
|
||||
FATFS *fs = dp->obj.fs;
|
||||
|
||||
|
||||
#if FF_FS_RPATH != 0
|
||||
if (*path != '/' && *path != '\\') { /* Without heading separator */
|
||||
dp->obj.sclust = fs->cdir; /* Start from current directory */
|
||||
} else
|
||||
#endif
|
||||
{ /* With heading separator */
|
||||
while (*path == '/' || *path == '\\') path++; /* Strip heading separator */
|
||||
dp->obj.sclust = 0; /* Start from root directory */
|
||||
}
|
||||
#if FF_FS_EXFAT
|
||||
dp->obj.n_frag = 0; /* Invalidate last fragment counter of the object */
|
||||
#if FF_FS_RPATH != 0
|
||||
if (fs->fs_type == FS_EXFAT && dp->obj.sclust) { /* exFAT: Retrieve the sub-directory's status */
|
||||
DIR dj;
|
||||
|
||||
dp->obj.c_scl = fs->cdc_scl;
|
||||
dp->obj.c_size = fs->cdc_size;
|
||||
dp->obj.c_ofs = fs->cdc_ofs;
|
||||
res = load_obj_xdir(&dj, &dp->obj);
|
||||
if (res != FR_OK) return res;
|
||||
dp->obj.objsize = ld_dword(fs->dirbuf + XDIR_FileSize);
|
||||
dp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
|
||||
}
|
||||
#endif
|
||||
#endif
|
||||
|
||||
if ((UINT)*path < ' ') { /* Null path name is the origin directory itself */
|
||||
dp->fn[NSFLAG] = NS_NONAME;
|
||||
res = dir_sdi(dp, 0);
|
||||
|
||||
} else { /* Follow path */
|
||||
for (;;) {
|
||||
res = create_name(dp, &path); /* Get a segment name of the path */
|
||||
if (res != FR_OK) break;
|
||||
res = dir_find(dp); /* Find an object with the segment name */
|
||||
ns = dp->fn[NSFLAG];
|
||||
if (res != FR_OK) { /* Failed to find the object */
|
||||
if (res == FR_NO_FILE) { /* Object is not found */
|
||||
if (FF_FS_RPATH && (ns & NS_DOT)) { /* If dot entry is not exist, stay there */
|
||||
if (!(ns & NS_LAST)) continue; /* Continue to follow if not last segment */
|
||||
dp->fn[NSFLAG] = NS_NONAME;
|
||||
res = FR_OK;
|
||||
} else { /* Could not find the object */
|
||||
if (!(ns & NS_LAST)) res = FR_NO_PATH; /* Adjust error code if not last segment */
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
if (ns & NS_LAST) break; /* Last segment matched. Function completed. */
|
||||
/* Get into the sub-directory */
|
||||
if (!(dp->obj.attr & AM_DIR)) { /* It is not a sub-directory and cannot follow */
|
||||
res = FR_NO_PATH; break;
|
||||
}
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* Save containing directory information for next dir */
|
||||
dp->obj.c_scl = dp->obj.sclust;
|
||||
dp->obj.c_size = ((DWORD)dp->obj.objsize & 0xFFFFFF00) | dp->obj.stat;
|
||||
dp->obj.c_ofs = dp->blk_ofs;
|
||||
dp->obj.sclust = ld_dword(fs->dirbuf + XDIR_FstClus); /* Open next directory */
|
||||
dp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
|
||||
dp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
dp->obj.sclust = ld_clust(fs, fs->win + dp->dptr % SS(fs)); /* Open next directory */
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get logical drive number from path name */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
int get_ldnumber ( /* Returns logical drive number (-1:invalid drive) */
|
||||
const TCHAR** path /* Pointer to pointer to the path name */
|
||||
)
|
||||
{
|
||||
const TCHAR *tp, *tt;
|
||||
UINT i;
|
||||
int vol = -1;
|
||||
#if FF_STR_VOLUME_ID /* Find string drive id */
|
||||
static const char* const volid[] = {FF_VOLUME_STRS};
|
||||
const char *sp;
|
||||
char c;
|
||||
TCHAR tc;
|
||||
#endif
|
||||
|
||||
|
||||
if (*path) { /* If the pointer is not a null */
|
||||
for (tt = *path; (UINT)*tt >= (FF_USE_LFN ? ' ' : '!') && *tt != ':'; tt++) ; /* Find a colon in the path */
|
||||
if (*tt == ':') { /* If a colon is exist in the path name */
|
||||
tp = *path;
|
||||
i = *tp++;
|
||||
if (IsDigit(i) && tp == tt) { /* Is there a numeric drive id + colon? */
|
||||
if ((i -= '0') < FF_VOLUMES) { /* If drive id is found, get the value and strip it */
|
||||
vol = (int)i;
|
||||
*path = ++tt;
|
||||
}
|
||||
}
|
||||
#if FF_STR_VOLUME_ID
|
||||
else { /* No numeric drive number, find string drive id */
|
||||
i = 0; tt++;
|
||||
do {
|
||||
sp = volid[i]; tp = *path;
|
||||
do { /* Compare a string drive id with path name */
|
||||
c = *sp++; tc = *tp++;
|
||||
if (IsLower(tc)) tc -= 0x20;
|
||||
} while (c && (TCHAR)c == tc);
|
||||
} while ((c || tp != tt) && ++i < FF_VOLUMES); /* Repeat for each id until pattern match */
|
||||
if (i < FF_VOLUMES) { /* If a drive id is found, get the value and strip it */
|
||||
vol = (int)i;
|
||||
*path = tt;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
} else { /* No volume id and use default drive */
|
||||
#if FF_FS_RPATH != 0 && FF_VOLUMES >= 2
|
||||
vol = CurrVol; /* Current drive */
|
||||
#else
|
||||
vol = 0; /* Drive 0 */
|
||||
#endif
|
||||
}
|
||||
}
|
||||
return vol;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Load a sector and check if it is an FAT VBR */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
BYTE check_fs ( /* 0:FAT, 1:exFAT, 2:Valid BS but not FAT, 3:Not a BS, 4:Disk error */
|
||||
FATFS* fs, /* Filesystem object */
|
||||
DWORD sect /* Sector# (lba) to load and check if it is an FAT-VBR or not */
|
||||
)
|
||||
{
|
||||
fs->wflag = 0; fs->winsect = 0xFFFFFFFF; /* Invaidate window */
|
||||
if (move_window(fs, sect) != FR_OK) return 4; /* Load boot record */
|
||||
|
||||
if (ld_word(fs->win + BS_55AA) != 0xAA55) return 3; /* Check boot record signature (always placed here even if the sector size is >512) */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (!mem_cmp(fs->win + BS_JmpBoot, "\xEB\x76\x90" "EXFAT ", 11)) return 1; /* Check if exFAT VBR */
|
||||
#endif
|
||||
if (fs->win[BS_JmpBoot] == 0xE9 || (fs->win[BS_JmpBoot] == 0xEB && fs->win[BS_JmpBoot + 2] == 0x90)) { /* Valid JumpBoot code? */
|
||||
if (!mem_cmp(fs->win + BS_FilSysType, "FAT", 3)) return 0; /* Is it an FAT VBR? */
|
||||
if (!mem_cmp(fs->win + BS_FilSysType32, "FAT32", 5)) return 0; /* Is it an FAT32 VBR? */
|
||||
}
|
||||
return 2; /* Valid BS but not FAT */
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Find logical drive and check if the volume is mounted */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT find_volume ( /* FR_OK(0): successful, !=0: any error occurred */
|
||||
const TCHAR** path, /* Pointer to pointer to the path name (drive number) */
|
||||
FATFS** rfs, /* Pointer to pointer to the found filesystem object */
|
||||
BYTE mode /* !=0: Check write protection for write access */
|
||||
)
|
||||
{
|
||||
BYTE fmt, *pt;
|
||||
int vol;
|
||||
DSTATUS stat;
|
||||
DWORD bsect, fasize, tsect, sysect, nclst, szbfat, br[4];
|
||||
WORD nrsv;
|
||||
FATFS *fs;
|
||||
UINT i;
|
||||
|
||||
|
||||
/* Get logical drive number */
|
||||
*rfs = 0;
|
||||
vol = get_ldnumber(path);
|
||||
if (vol < 0) return FR_INVALID_DRIVE;
|
||||
|
||||
/* Check if the filesystem object is valid or not */
|
||||
fs = FatFs[vol]; /* Get pointer to the filesystem object */
|
||||
if (!fs) return FR_NOT_ENABLED; /* Is the filesystem object available? */
|
||||
#if FF_FS_REENTRANT
|
||||
if (!lock_fs(fs)) return FR_TIMEOUT; /* Lock the volume */
|
||||
#endif
|
||||
*rfs = fs; /* Return pointer to the filesystem object */
|
||||
|
||||
mode &= (BYTE)~FA_READ; /* Desired access mode, write access or not */
|
||||
if (fs->fs_type != 0) { /* If the volume has been mounted */
|
||||
stat = disk_status(fs->pdrv);
|
||||
if (!(stat & STA_NOINIT)) { /* and the physical drive is kept initialized */
|
||||
if (!FF_FS_READONLY && mode && (stat & STA_PROTECT)) { /* Check write protection if needed */
|
||||
return FR_WRITE_PROTECTED;
|
||||
}
|
||||
return FR_OK; /* The filesystem object is valid */
|
||||
}
|
||||
}
|
||||
|
||||
/* The filesystem object is not valid. */
|
||||
/* Following code attempts to mount the volume. (analyze BPB and initialize the filesystem object) */
|
||||
|
||||
fs->fs_type = 0; /* Clear the filesystem object */
|
||||
fs->pdrv = LD2PD(vol); /* Bind the logical drive and a physical drive */
|
||||
stat = disk_initialize(fs->pdrv); /* Initialize the physical drive */
|
||||
if (stat & STA_NOINIT) { /* Check if the initialization succeeded */
|
||||
return FR_NOT_READY; /* Failed to initialize due to no medium or hard error */
|
||||
}
|
||||
if (!FF_FS_READONLY && mode && (stat & STA_PROTECT)) { /* Check disk write protection if needed */
|
||||
return FR_WRITE_PROTECTED;
|
||||
}
|
||||
#if FF_MAX_SS != FF_MIN_SS /* Get sector size (multiple sector size cfg only) */
|
||||
if (disk_ioctl(fs->pdrv, GET_SECTOR_SIZE, &SS(fs)) != RES_OK) return FR_DISK_ERR;
|
||||
if (SS(fs) > FF_MAX_SS || SS(fs) < FF_MIN_SS || (SS(fs) & (SS(fs) - 1))) return FR_DISK_ERR;
|
||||
#endif
|
||||
|
||||
/* Find an FAT partition on the drive. Supports only generic partitioning rules, FDISK and SFD. */
|
||||
bsect = 0;
|
||||
fmt = check_fs(fs, bsect); /* Load sector 0 and check if it is an FAT-VBR as SFD */
|
||||
if (fmt == 2 || (fmt < 2 && LD2PT(vol) != 0)) { /* Not an FAT-VBR or forced partition number */
|
||||
for (i = 0; i < 4; i++) { /* Get partition offset */
|
||||
pt = fs->win + (MBR_Table + i * SZ_PTE);
|
||||
br[i] = pt[PTE_System] ? ld_dword(pt + PTE_StLba) : 0;
|
||||
}
|
||||
i = LD2PT(vol); /* Partition number: 0:auto, 1-4:forced */
|
||||
if (i != 0) i--;
|
||||
do { /* Find an FAT volume */
|
||||
bsect = br[i];
|
||||
fmt = bsect ? check_fs(fs, bsect) : 3; /* Check the partition */
|
||||
} while (LD2PT(vol) == 0 && fmt >= 2 && ++i < 4);
|
||||
}
|
||||
if (fmt == 4) return FR_DISK_ERR; /* An error occured in the disk I/O layer */
|
||||
if (fmt >= 2) return FR_NO_FILESYSTEM; /* No FAT volume is found */
|
||||
|
||||
/* An FAT volume is found (bsect). Following code initializes the filesystem object */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (fmt == 1) {
|
||||
QWORD maxlba;
|
||||
|
||||
for (i = BPB_ZeroedEx; i < BPB_ZeroedEx + 53 && fs->win[i] == 0; i++) ; /* Check zero filler */
|
||||
if (i < BPB_ZeroedEx + 53) return FR_NO_FILESYSTEM;
|
||||
|
||||
if (ld_word(fs->win + BPB_FSVerEx) != 0x100) return FR_NO_FILESYSTEM; /* Check exFAT version (must be version 1.0) */
|
||||
|
||||
if (1 << fs->win[BPB_BytsPerSecEx] != SS(fs)) { /* (BPB_BytsPerSecEx must be equal to the physical sector size) */
|
||||
return FR_NO_FILESYSTEM;
|
||||
}
|
||||
|
||||
maxlba = ld_qword(fs->win + BPB_TotSecEx) + bsect; /* Last LBA + 1 of the volume */
|
||||
if (maxlba >= 0x100000000) return FR_NO_FILESYSTEM; /* (It cannot be handled in 32-bit LBA) */
|
||||
|
||||
fs->fsize = ld_dword(fs->win + BPB_FatSzEx); /* Number of sectors per FAT */
|
||||
|
||||
fs->n_fats = fs->win[BPB_NumFATsEx]; /* Number of FATs */
|
||||
if (fs->n_fats != 1) return FR_NO_FILESYSTEM; /* (Supports only 1 FAT) */
|
||||
|
||||
fs->csize = 1 << fs->win[BPB_SecPerClusEx]; /* Cluster size */
|
||||
if (fs->csize == 0) return FR_NO_FILESYSTEM; /* (Must be 1..32768) */
|
||||
|
||||
nclst = ld_dword(fs->win + BPB_NumClusEx); /* Number of clusters */
|
||||
if (nclst > MAX_EXFAT) return FR_NO_FILESYSTEM; /* (Too many clusters) */
|
||||
fs->n_fatent = nclst + 2;
|
||||
|
||||
/* Boundaries and Limits */
|
||||
fs->volbase = bsect;
|
||||
fs->database = bsect + ld_dword(fs->win + BPB_DataOfsEx);
|
||||
fs->fatbase = bsect + ld_dword(fs->win + BPB_FatOfsEx);
|
||||
if (maxlba < (QWORD)fs->database + nclst * fs->csize) return FR_NO_FILESYSTEM; /* (Volume size must not be smaller than the size requiered) */
|
||||
fs->dirbase = ld_dword(fs->win + BPB_RootClusEx);
|
||||
|
||||
/* Check if bitmap location is in assumption (at the first cluster) */
|
||||
if (move_window(fs, clst2sect(fs, fs->dirbase)) != FR_OK) return FR_DISK_ERR;
|
||||
for (i = 0; i < SS(fs); i += SZDIRE) {
|
||||
if (fs->win[i] == 0x81 && ld_dword(fs->win + i + 20) == 2) break; /* 81 entry with cluster #2? */
|
||||
}
|
||||
if (i == SS(fs)) return FR_NO_FILESYSTEM;
|
||||
#if !FF_FS_READONLY
|
||||
fs->last_clst = fs->free_clst = 0xFFFFFFFF; /* Initialize cluster allocation information */
|
||||
#endif
|
||||
fmt = FS_EXFAT; /* FAT sub-type */
|
||||
} else
|
||||
#endif /* FF_FS_EXFAT */
|
||||
{
|
||||
if (ld_word(fs->win + BPB_BytsPerSec) != SS(fs)) return FR_NO_FILESYSTEM; /* (BPB_BytsPerSec must be equal to the physical sector size) */
|
||||
|
||||
fasize = ld_word(fs->win + BPB_FATSz16); /* Number of sectors per FAT */
|
||||
if (fasize == 0) fasize = ld_dword(fs->win + BPB_FATSz32);
|
||||
fs->fsize = fasize;
|
||||
|
||||
fs->n_fats = fs->win[BPB_NumFATs]; /* Number of FATs */
|
||||
if (fs->n_fats != 1 && fs->n_fats != 2) return FR_NO_FILESYSTEM; /* (Must be 1 or 2) */
|
||||
fasize *= fs->n_fats; /* Number of sectors for FAT area */
|
||||
|
||||
fs->csize = fs->win[BPB_SecPerClus]; /* Cluster size */
|
||||
if (fs->csize == 0 || (fs->csize & (fs->csize - 1))) return FR_NO_FILESYSTEM; /* (Must be power of 2) */
|
||||
|
||||
fs->n_rootdir = ld_word(fs->win + BPB_RootEntCnt); /* Number of root directory entries */
|
||||
if (fs->n_rootdir % (SS(fs) / SZDIRE)) return FR_NO_FILESYSTEM; /* (Must be sector aligned) */
|
||||
|
||||
tsect = ld_word(fs->win + BPB_TotSec16); /* Number of sectors on the volume */
|
||||
if (tsect == 0) tsect = ld_dword(fs->win + BPB_TotSec32);
|
||||
|
||||
nrsv = ld_word(fs->win + BPB_RsvdSecCnt); /* Number of reserved sectors */
|
||||
if (nrsv == 0) return FR_NO_FILESYSTEM; /* (Must not be 0) */
|
||||
|
||||
/* Determine the FAT sub type */
|
||||
sysect = nrsv + fasize + fs->n_rootdir / (SS(fs) / SZDIRE); /* RSV + FAT + DIR */
|
||||
if (tsect < sysect) return FR_NO_FILESYSTEM; /* (Invalid volume size) */
|
||||
nclst = (tsect - sysect) / fs->csize; /* Number of clusters */
|
||||
if (nclst == 0) return FR_NO_FILESYSTEM; /* (Invalid volume size) */
|
||||
fmt = 0;
|
||||
if (nclst <= MAX_FAT32) fmt = FS_FAT32;
|
||||
if (nclst <= MAX_FAT16) fmt = FS_FAT16;
|
||||
if (nclst <= MAX_FAT12) fmt = FS_FAT12;
|
||||
if (fmt == 0) return FR_NO_FILESYSTEM;
|
||||
|
||||
/* Boundaries and Limits */
|
||||
fs->n_fatent = nclst + 2; /* Number of FAT entries */
|
||||
fs->volbase = bsect; /* Volume start sector */
|
||||
fs->fatbase = bsect + nrsv; /* FAT start sector */
|
||||
fs->database = bsect + sysect; /* Data start sector */
|
||||
if (fmt == FS_FAT32) {
|
||||
if (ld_word(fs->win + BPB_FSVer32) != 0) return FR_NO_FILESYSTEM; /* (Must be FAT32 revision 0.0) */
|
||||
if (fs->n_rootdir != 0) return FR_NO_FILESYSTEM; /* (BPB_RootEntCnt must be 0) */
|
||||
fs->dirbase = ld_dword(fs->win + BPB_RootClus32); /* Root directory start cluster */
|
||||
szbfat = fs->n_fatent * 4; /* (Needed FAT size) */
|
||||
} else {
|
||||
if (fs->n_rootdir == 0) return FR_NO_FILESYSTEM; /* (BPB_RootEntCnt must not be 0) */
|
||||
fs->dirbase = fs->fatbase + fasize; /* Root directory start sector */
|
||||
szbfat = (fmt == FS_FAT16) ? /* (Needed FAT size) */
|
||||
fs->n_fatent * 2 : fs->n_fatent * 3 / 2 + (fs->n_fatent & 1);
|
||||
}
|
||||
if (fs->fsize < (szbfat + (SS(fs) - 1)) / SS(fs)) return FR_NO_FILESYSTEM; /* (BPB_FATSz must not be less than the size needed) */
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/* Get FSInfo if available */
|
||||
fs->last_clst = fs->free_clst = 0xFFFFFFFF; /* Initialize cluster allocation information */
|
||||
fs->fsi_flag = 0x80;
|
||||
#if (FF_FS_NOFSINFO & 3) != 3
|
||||
if (fmt == FS_FAT32 /* Allow to update FSInfo only if BPB_FSInfo32 == 1 */
|
||||
&& ld_word(fs->win + BPB_FSInfo32) == 1
|
||||
&& move_window(fs, bsect + 1) == FR_OK)
|
||||
{
|
||||
fs->fsi_flag = 0;
|
||||
if (ld_word(fs->win + BS_55AA) == 0xAA55 /* Load FSInfo data if available */
|
||||
&& ld_dword(fs->win + FSI_LeadSig) == 0x41615252
|
||||
&& ld_dword(fs->win + FSI_StrucSig) == 0x61417272)
|
||||
{
|
||||
#if (FF_FS_NOFSINFO & 1) == 0
|
||||
fs->free_clst = ld_dword(fs->win + FSI_Free_Count);
|
||||
#endif
|
||||
#if (FF_FS_NOFSINFO & 2) == 0
|
||||
fs->last_clst = ld_dword(fs->win + FSI_Nxt_Free);
|
||||
#endif
|
||||
}
|
||||
}
|
||||
#endif /* (FF_FS_NOFSINFO & 3) != 3 */
|
||||
#endif /* !FF_FS_READONLY */
|
||||
}
|
||||
|
||||
fs->fs_type = fmt; /* FAT sub-type */
|
||||
fs->id = ++Fsid; /* Volume mount ID */
|
||||
#if FF_USE_LFN == 1
|
||||
fs->lfnbuf = LfnBuf; /* Static LFN working buffer */
|
||||
#if FF_FS_EXFAT
|
||||
fs->dirbuf = DirBuf; /* Static directory block scratchpad buuffer */
|
||||
#endif
|
||||
#endif
|
||||
#if FF_FS_RPATH != 0
|
||||
fs->cdir = 0; /* Initialize current directory */
|
||||
#endif
|
||||
#if FF_FS_LOCK != 0 /* Clear file lock semaphores */
|
||||
clear_lock(fs);
|
||||
#endif
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Check if the file/directory object is valid or not */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
FRESULT validate ( /* Returns FR_OK or FR_INVALID_OBJECT */
|
||||
FFOBJID* obj, /* Pointer to the FFOBJID, the 1st member in the FIL/DIR object, to check validity */
|
||||
FATFS** rfs /* Pointer to pointer to the owner filesystem object to return */
|
||||
)
|
||||
{
|
||||
FRESULT res = FR_INVALID_OBJECT;
|
||||
|
||||
|
||||
if (obj && obj->fs && obj->fs->fs_type && obj->id == obj->fs->id) { /* Test if the object is valid */
|
||||
#if FF_FS_REENTRANT
|
||||
if (lock_fs(obj->fs)) { /* Obtain the filesystem object */
|
||||
if (!(disk_status(obj->fs->pdrv) & STA_NOINIT)) { /* Test if the phsical drive is kept initialized */
|
||||
res = FR_OK;
|
||||
} else {
|
||||
unlock_fs(obj->fs, FR_OK);
|
||||
}
|
||||
} else {
|
||||
res = FR_TIMEOUT;
|
||||
}
|
||||
#else
|
||||
if (!(disk_status(obj->fs->pdrv) & STA_NOINIT)) { /* Test if the phsical drive is kept initialized */
|
||||
res = FR_OK;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
*rfs = (res == FR_OK) ? obj->fs : 0; /* Corresponding filesystem object */
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*---------------------------------------------------------------------------
|
||||
|
||||
Public Functions (FatFs API)
|
||||
|
||||
----------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Mount/Unmount a Logical Drive */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_mount (
|
||||
FATFS* fs, /* Pointer to the filesystem object (NULL:unmount)*/
|
||||
const TCHAR* path, /* Logical drive number to be mounted/unmounted */
|
||||
BYTE opt /* Mode option 0:Do not mount (delayed mount), 1:Mount immediately */
|
||||
)
|
||||
{
|
||||
FATFS *cfs;
|
||||
int vol;
|
||||
FRESULT res;
|
||||
const TCHAR *rp = path;
|
||||
|
||||
|
||||
/* Get logical drive number */
|
||||
vol = get_ldnumber(&rp);
|
||||
if (vol < 0) return FR_INVALID_DRIVE;
|
||||
cfs = FatFs[vol]; /* Pointer to fs object */
|
||||
|
||||
if (cfs) {
|
||||
#if FF_FS_LOCK != 0
|
||||
clear_lock(cfs);
|
||||
#endif
|
||||
#if FF_FS_REENTRANT /* Discard sync object of the current volume */
|
||||
if (!ff_del_syncobj(cfs->sobj)) return FR_INT_ERR;
|
||||
#endif
|
||||
cfs->fs_type = 0; /* Clear old fs object */
|
||||
}
|
||||
|
||||
if (fs) {
|
||||
fs->fs_type = 0; /* Clear new fs object */
|
||||
#if FF_FS_REENTRANT /* Create sync object for the new volume */
|
||||
if (!ff_cre_syncobj((BYTE)vol, &fs->sobj)) return FR_INT_ERR;
|
||||
#endif
|
||||
}
|
||||
FatFs[vol] = fs; /* Register new fs object */
|
||||
|
||||
if (opt == 0) return FR_OK; /* Do not mount now, it will be mounted later */
|
||||
|
||||
res = find_volume(&path, &fs, 0); /* Force mounted the volume */
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Open or Create a File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_open (
|
||||
FIL* fp, /* Pointer to the blank file object */
|
||||
const TCHAR* path, /* Pointer to the file name */
|
||||
BYTE mode /* Access mode and file open mode flags */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
#if !FF_FS_READONLY
|
||||
DWORD dw, cl, bcs, clst, sc;
|
||||
FSIZE_t ofs;
|
||||
#endif
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
if (!fp) return FR_INVALID_OBJECT;
|
||||
|
||||
/* Get logical drive */
|
||||
mode &= FF_FS_READONLY ? FA_READ : FA_READ | FA_WRITE | FA_CREATE_ALWAYS | FA_CREATE_NEW | FA_OPEN_ALWAYS | FA_OPEN_APPEND | FA_SEEKEND;
|
||||
res = find_volume(&path, &fs, mode);
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&dj, path); /* Follow the file path */
|
||||
#if !FF_FS_READONLY /* Read/Write configuration */
|
||||
if (res == FR_OK) {
|
||||
if (dj.fn[NSFLAG] & NS_NONAME) { /* Origin directory itself? */
|
||||
res = FR_INVALID_NAME;
|
||||
}
|
||||
#if FF_FS_LOCK != 0
|
||||
else {
|
||||
res = chk_lock(&dj, (mode & ~FA_READ) ? 1 : 0); /* Check if the file can be used */
|
||||
}
|
||||
#endif
|
||||
}
|
||||
/* Create or Open a file */
|
||||
if (mode & (FA_CREATE_ALWAYS | FA_OPEN_ALWAYS | FA_CREATE_NEW)) {
|
||||
if (res != FR_OK) { /* No file, create new */
|
||||
if (res == FR_NO_FILE) { /* There is no file to open, create a new entry */
|
||||
#if FF_FS_LOCK != 0
|
||||
res = enq_lock() ? dir_register(&dj) : FR_TOO_MANY_OPEN_FILES;
|
||||
#else
|
||||
res = dir_register(&dj);
|
||||
#endif
|
||||
}
|
||||
mode |= FA_CREATE_ALWAYS; /* File is created */
|
||||
}
|
||||
else { /* Any object with the same name is already existing */
|
||||
if (dj.obj.attr & (AM_RDO | AM_DIR)) { /* Cannot overwrite it (R/O or DIR) */
|
||||
res = FR_DENIED;
|
||||
} else {
|
||||
if (mode & FA_CREATE_NEW) res = FR_EXIST; /* Cannot create as new file */
|
||||
}
|
||||
}
|
||||
if (res == FR_OK && (mode & FA_CREATE_ALWAYS)) { /* Truncate the file if overwrite mode */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
/* Get current allocation info */
|
||||
fp->obj.fs = fs;
|
||||
fp->obj.sclust = cl = ld_dword(fs->dirbuf + XDIR_FstClus);
|
||||
fp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
|
||||
fp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
|
||||
fp->obj.n_frag = 0;
|
||||
/* Set directory entry block initial state */
|
||||
mem_set(fs->dirbuf + 2, 0, 30); /* Clear 85 entry except for NumSec */
|
||||
mem_set(fs->dirbuf + 38, 0, 26); /* Clear C0 entry except for NumName and NameHash */
|
||||
fs->dirbuf[XDIR_Attr] = AM_ARC;
|
||||
st_dword(fs->dirbuf + XDIR_CrtTime, GET_FATTIME());
|
||||
fs->dirbuf[XDIR_GenFlags] = 1;
|
||||
res = store_xdir(&dj);
|
||||
if (res == FR_OK && cl != 0) { /* Remove the cluster chain if exist */
|
||||
res = remove_chain(&fp->obj, cl, 0);
|
||||
fs->last_clst = cl - 1; /* Reuse the cluster hole */
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
/* Set directory entry initial state */
|
||||
cl = ld_clust(fs, dj.dir); /* Get current cluster chain */
|
||||
st_dword(dj.dir + DIR_CrtTime, GET_FATTIME()); /* Set created time */
|
||||
dj.dir[DIR_Attr] = AM_ARC; /* Reset attribute */
|
||||
st_clust(fs, dj.dir, 0); /* Reset file allocation info */
|
||||
st_dword(dj.dir + DIR_FileSize, 0);
|
||||
fs->wflag = 1;
|
||||
if (cl != 0) { /* Remove the cluster chain if exist */
|
||||
dw = fs->winsect;
|
||||
res = remove_chain(&dj.obj, cl, 0);
|
||||
if (res == FR_OK) {
|
||||
res = move_window(fs, dw);
|
||||
fs->last_clst = cl - 1; /* Reuse the cluster hole */
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
else { /* Open an existing file */
|
||||
if (res == FR_OK) { /* Is the object exsiting? */
|
||||
if (dj.obj.attr & AM_DIR) { /* File open against a directory */
|
||||
res = FR_NO_FILE;
|
||||
} else {
|
||||
if ((mode & FA_WRITE) && (dj.obj.attr & AM_RDO)) { /* Write mode open against R/O file */
|
||||
res = FR_DENIED;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
if (mode & FA_CREATE_ALWAYS) mode |= FA_MODIFIED; /* Set file change flag if created or overwritten */
|
||||
fp->dir_sect = fs->winsect; /* Pointer to the directory entry */
|
||||
fp->dir_ptr = dj.dir;
|
||||
#if FF_FS_LOCK != 0
|
||||
fp->obj.lockid = inc_lock(&dj, (mode & ~FA_READ) ? 1 : 0); /* Lock the file for this session */
|
||||
if (!fp->obj.lockid) res = FR_INT_ERR;
|
||||
#endif
|
||||
}
|
||||
#else /* R/O configuration */
|
||||
if (res == FR_OK) {
|
||||
if (dj.fn[NSFLAG] & NS_NONAME) { /* Is it origin directory itself? */
|
||||
res = FR_INVALID_NAME;
|
||||
} else {
|
||||
if (dj.obj.attr & AM_DIR) { /* Is it a directory? */
|
||||
res = FR_NO_FILE;
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
fp->obj.c_scl = dj.obj.sclust; /* Get containing directory info */
|
||||
fp->obj.c_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat;
|
||||
fp->obj.c_ofs = dj.blk_ofs;
|
||||
fp->obj.sclust = ld_dword(fs->dirbuf + XDIR_FstClus); /* Get object allocation info */
|
||||
fp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
|
||||
fp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
|
||||
fp->obj.n_frag = 0;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
fp->obj.sclust = ld_clust(fs, dj.dir); /* Get object allocation info */
|
||||
fp->obj.objsize = ld_dword(dj.dir + DIR_FileSize);
|
||||
}
|
||||
#if FF_USE_FASTSEEK
|
||||
fp->cltbl = 0; /* Disable fast seek mode */
|
||||
#endif
|
||||
fp->obj.fs = fs; /* Validate the file object */
|
||||
fp->obj.id = fs->id;
|
||||
fp->flag = mode; /* Set file access mode */
|
||||
fp->err = 0; /* Clear error flag */
|
||||
fp->sect = 0; /* Invalidate current data sector */
|
||||
fp->fptr = 0; /* Set file pointer top of the file */
|
||||
#if !FF_FS_READONLY
|
||||
#if !FF_FS_TINY
|
||||
mem_set(fp->buf, 0, FF_MAX_SS); /* Clear sector buffer */
|
||||
#endif
|
||||
if ((mode & FA_SEEKEND) && fp->obj.objsize > 0) { /* Seek to end of file if FA_OPEN_APPEND is specified */
|
||||
fp->fptr = fp->obj.objsize; /* Offset to seek */
|
||||
bcs = (DWORD)fs->csize * SS(fs); /* Cluster size in byte */
|
||||
clst = fp->obj.sclust; /* Follow the cluster chain */
|
||||
for (ofs = fp->obj.objsize; res == FR_OK && ofs > bcs; ofs -= bcs) {
|
||||
clst = get_fat(&fp->obj, clst);
|
||||
if (clst <= 1) res = FR_INT_ERR;
|
||||
if (clst == 0xFFFFFFFF) res = FR_DISK_ERR;
|
||||
}
|
||||
fp->clust = clst;
|
||||
if (res == FR_OK && ofs % SS(fs)) { /* Fill sector buffer if not on the sector boundary */
|
||||
if ((sc = clst2sect(fs, clst)) == 0) {
|
||||
res = FR_INT_ERR;
|
||||
} else {
|
||||
fp->sect = sc + (DWORD)(ofs / SS(fs));
|
||||
#if !FF_FS_TINY
|
||||
if (disk_read(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) res = FR_DISK_ERR;
|
||||
#endif
|
||||
}
|
||||
}
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
if (res != FR_OK) fp->obj.fs = 0; /* Invalidate file object on error */
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Read File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_read (
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
void* buff, /* Pointer to data buffer */
|
||||
UINT btr, /* Number of bytes to read */
|
||||
UINT* br /* Pointer to number of bytes read */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD clst, sect;
|
||||
FSIZE_t remain;
|
||||
UINT rcnt, cc, csect;
|
||||
BYTE *rbuff = (BYTE*)buff;
|
||||
|
||||
|
||||
*br = 0; /* Clear read byte counter */
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); /* Check validity */
|
||||
if (!(fp->flag & FA_READ)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */
|
||||
remain = fp->obj.objsize - fp->fptr;
|
||||
if (btr > remain) btr = (UINT)remain; /* Truncate btr by remaining bytes */
|
||||
|
||||
for ( ; btr; /* Repeat until all data read */
|
||||
btr -= rcnt, *br += rcnt, rbuff += rcnt, fp->fptr += rcnt) {
|
||||
if (fp->fptr % SS(fs) == 0) { /* On the sector boundary? */
|
||||
csect = (UINT)(fp->fptr / SS(fs) & (fs->csize - 1)); /* Sector offset in the cluster */
|
||||
if (csect == 0) { /* On the cluster boundary? */
|
||||
if (fp->fptr == 0) { /* On the top of the file? */
|
||||
clst = fp->obj.sclust; /* Follow cluster chain from the origin */
|
||||
} else { /* Middle or end of the file */
|
||||
#if FF_USE_FASTSEEK
|
||||
if (fp->cltbl) {
|
||||
clst = clmt_clust(fp, fp->fptr); /* Get cluster# from the CLMT */
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
clst = get_fat(&fp->obj, fp->clust); /* Follow cluster chain on the FAT */
|
||||
}
|
||||
}
|
||||
if (clst < 2) ABORT(fs, FR_INT_ERR);
|
||||
if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
|
||||
fp->clust = clst; /* Update current cluster */
|
||||
}
|
||||
sect = clst2sect(fs, fp->clust); /* Get current sector */
|
||||
if (sect == 0) ABORT(fs, FR_INT_ERR);
|
||||
sect += csect;
|
||||
cc = btr / SS(fs); /* When remaining bytes >= sector size, */
|
||||
if (cc > 0) { /* Read maximum contiguous sectors directly */
|
||||
if (csect + cc > fs->csize) { /* Clip at cluster boundary */
|
||||
cc = fs->csize - csect;
|
||||
}
|
||||
if (disk_read(fs->pdrv, rbuff, sect, cc) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
#if !FF_FS_READONLY && FF_FS_MINIMIZE <= 2 /* Replace one of the read sectors with cached data if it contains a dirty sector */
|
||||
#if FF_FS_TINY
|
||||
if (fs->wflag && fs->winsect - sect < cc) {
|
||||
mem_cpy(rbuff + ((fs->winsect - sect) * SS(fs)), fs->win, SS(fs));
|
||||
}
|
||||
#else
|
||||
if ((fp->flag & FA_DIRTY) && fp->sect - sect < cc) {
|
||||
mem_cpy(rbuff + ((fp->sect - sect) * SS(fs)), fp->buf, SS(fs));
|
||||
}
|
||||
#endif
|
||||
#endif
|
||||
rcnt = SS(fs) * cc; /* Number of bytes transferred */
|
||||
continue;
|
||||
}
|
||||
#if !FF_FS_TINY
|
||||
if (fp->sect != sect) { /* Load data sector if not in cache */
|
||||
#if !FF_FS_READONLY
|
||||
if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
if (disk_read(fs->pdrv, fp->buf, sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); /* Fill sector cache */
|
||||
}
|
||||
#endif
|
||||
fp->sect = sect;
|
||||
}
|
||||
rcnt = SS(fs) - (UINT)fp->fptr % SS(fs); /* Number of bytes left in the sector */
|
||||
if (rcnt > btr) rcnt = btr; /* Clip it by btr if needed */
|
||||
#if FF_FS_TINY
|
||||
if (move_window(fs, fp->sect) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Move sector window */
|
||||
mem_cpy(rbuff, fs->win + fp->fptr % SS(fs), rcnt); /* Extract partial sector */
|
||||
#else
|
||||
mem_cpy(rbuff, fp->buf + fp->fptr % SS(fs), rcnt); /* Extract partial sector */
|
||||
#endif
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, FR_OK);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Write File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_write (
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
const void* buff, /* Pointer to the data to be written */
|
||||
UINT btw, /* Number of bytes to write */
|
||||
UINT* bw /* Pointer to number of bytes written */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD clst, sect;
|
||||
UINT wcnt, cc, csect;
|
||||
const BYTE *wbuff = (const BYTE*)buff;
|
||||
|
||||
|
||||
*bw = 0; /* Clear write byte counter */
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res); /* Check validity */
|
||||
if (!(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */
|
||||
|
||||
/* Check fptr wrap-around (file size cannot reach 4 GiB at FAT volume) */
|
||||
if ((!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) && (DWORD)(fp->fptr + btw) < (DWORD)fp->fptr) {
|
||||
btw = (UINT)(0xFFFFFFFF - (DWORD)fp->fptr);
|
||||
}
|
||||
|
||||
for ( ; btw; /* Repeat until all data written */
|
||||
btw -= wcnt, *bw += wcnt, wbuff += wcnt, fp->fptr += wcnt, fp->obj.objsize = (fp->fptr > fp->obj.objsize) ? fp->fptr : fp->obj.objsize) {
|
||||
if (fp->fptr % SS(fs) == 0) { /* On the sector boundary? */
|
||||
csect = (UINT)(fp->fptr / SS(fs)) & (fs->csize - 1); /* Sector offset in the cluster */
|
||||
if (csect == 0) { /* On the cluster boundary? */
|
||||
if (fp->fptr == 0) { /* On the top of the file? */
|
||||
clst = fp->obj.sclust; /* Follow from the origin */
|
||||
if (clst == 0) { /* If no cluster is allocated, */
|
||||
clst = create_chain(&fp->obj, 0); /* create a new cluster chain */
|
||||
}
|
||||
} else { /* On the middle or end of the file */
|
||||
#if FF_USE_FASTSEEK
|
||||
if (fp->cltbl) {
|
||||
clst = clmt_clust(fp, fp->fptr); /* Get cluster# from the CLMT */
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
clst = create_chain(&fp->obj, fp->clust); /* Follow or stretch cluster chain on the FAT */
|
||||
}
|
||||
}
|
||||
if (clst == 0) break; /* Could not allocate a new cluster (disk full) */
|
||||
if (clst == 1) ABORT(fs, FR_INT_ERR);
|
||||
if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
|
||||
fp->clust = clst; /* Update current cluster */
|
||||
if (fp->obj.sclust == 0) fp->obj.sclust = clst; /* Set start cluster if the first write */
|
||||
}
|
||||
#if FF_FS_TINY
|
||||
if (fs->winsect == fp->sect && sync_window(fs) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Write-back sector cache */
|
||||
#else
|
||||
if (fp->flag & FA_DIRTY) { /* Write-back sector cache */
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
sect = clst2sect(fs, fp->clust); /* Get current sector */
|
||||
if (sect == 0) ABORT(fs, FR_INT_ERR);
|
||||
sect += csect;
|
||||
cc = btw / SS(fs); /* When remaining bytes >= sector size, */
|
||||
if (cc > 0) { /* Write maximum contiguous sectors directly */
|
||||
if (csect + cc > fs->csize) { /* Clip at cluster boundary */
|
||||
cc = fs->csize - csect;
|
||||
}
|
||||
if (disk_write(fs->pdrv, wbuff, sect, cc) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
#if FF_FS_MINIMIZE <= 2
|
||||
#if FF_FS_TINY
|
||||
if (fs->winsect - sect < cc) { /* Refill sector cache if it gets invalidated by the direct write */
|
||||
mem_cpy(fs->win, wbuff + ((fs->winsect - sect) * SS(fs)), SS(fs));
|
||||
fs->wflag = 0;
|
||||
}
|
||||
#else
|
||||
if (fp->sect - sect < cc) { /* Refill sector cache if it gets invalidated by the direct write */
|
||||
mem_cpy(fp->buf, wbuff + ((fp->sect - sect) * SS(fs)), SS(fs));
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
#endif
|
||||
wcnt = SS(fs) * cc; /* Number of bytes transferred */
|
||||
continue;
|
||||
}
|
||||
#if FF_FS_TINY
|
||||
if (fp->fptr >= fp->obj.objsize) { /* Avoid silly cache filling on the growing edge */
|
||||
if (sync_window(fs) != FR_OK) ABORT(fs, FR_DISK_ERR);
|
||||
fs->winsect = sect;
|
||||
}
|
||||
#else
|
||||
if (fp->sect != sect && /* Fill sector cache with file data */
|
||||
fp->fptr < fp->obj.objsize &&
|
||||
disk_read(fs->pdrv, fp->buf, sect, 1) != RES_OK) {
|
||||
ABORT(fs, FR_DISK_ERR);
|
||||
}
|
||||
#endif
|
||||
fp->sect = sect;
|
||||
}
|
||||
wcnt = SS(fs) - (UINT)fp->fptr % SS(fs); /* Number of bytes left in the sector */
|
||||
if (wcnt > btw) wcnt = btw; /* Clip it by btw if needed */
|
||||
#if FF_FS_TINY
|
||||
if (move_window(fs, fp->sect) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Move sector window */
|
||||
mem_cpy(fs->win + fp->fptr % SS(fs), wbuff, wcnt); /* Fit data to the sector */
|
||||
fs->wflag = 1;
|
||||
#else
|
||||
mem_cpy(fp->buf + fp->fptr % SS(fs), wbuff, wcnt); /* Fit data to the sector */
|
||||
fp->flag |= FA_DIRTY;
|
||||
#endif
|
||||
}
|
||||
|
||||
fp->flag |= FA_MODIFIED; /* Set file change flag */
|
||||
|
||||
LEAVE_FF(fs, FR_OK);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Synchronize the File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_sync (
|
||||
FIL* fp /* Pointer to the file object */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD tm;
|
||||
BYTE *dir;
|
||||
|
||||
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res == FR_OK) {
|
||||
if (fp->flag & FA_MODIFIED) { /* Is there any change to the file? */
|
||||
#if !FF_FS_TINY
|
||||
if (fp->flag & FA_DIRTY) { /* Write-back cached data if needed */
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) LEAVE_FF(fs, FR_DISK_ERR);
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
/* Update the directory entry */
|
||||
tm = GET_FATTIME(); /* Modified time */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
res = fill_first_frag(&fp->obj); /* Fill first fragment on the FAT if needed */
|
||||
if (res == FR_OK) {
|
||||
res = fill_last_frag(&fp->obj, fp->clust, 0xFFFFFFFF); /* Fill last fragment on the FAT if needed */
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
DIR dj;
|
||||
DEF_NAMBUF
|
||||
|
||||
INIT_NAMBUF(fs);
|
||||
res = load_obj_xdir(&dj, &fp->obj); /* Load directory entry block */
|
||||
if (res == FR_OK) {
|
||||
fs->dirbuf[XDIR_Attr] |= AM_ARC; /* Set archive attribute to indicate that the file has been changed */
|
||||
fs->dirbuf[XDIR_GenFlags] = fp->obj.stat | 1; /* Update file allocation information */
|
||||
st_dword(fs->dirbuf + XDIR_FstClus, fp->obj.sclust);
|
||||
st_qword(fs->dirbuf + XDIR_FileSize, fp->obj.objsize);
|
||||
st_qword(fs->dirbuf + XDIR_ValidFileSize, fp->obj.objsize);
|
||||
st_dword(fs->dirbuf + XDIR_ModTime, tm); /* Update modified time */
|
||||
fs->dirbuf[XDIR_ModTime10] = 0;
|
||||
st_dword(fs->dirbuf + XDIR_AccTime, 0);
|
||||
res = store_xdir(&dj); /* Restore it to the directory */
|
||||
if (res == FR_OK) {
|
||||
res = sync_fs(fs);
|
||||
fp->flag &= (BYTE)~FA_MODIFIED;
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
res = move_window(fs, fp->dir_sect);
|
||||
if (res == FR_OK) {
|
||||
dir = fp->dir_ptr;
|
||||
dir[DIR_Attr] |= AM_ARC; /* Set archive attribute to indicate that the file has been changed */
|
||||
st_clust(fp->obj.fs, dir, fp->obj.sclust); /* Update file allocation information */
|
||||
st_dword(dir + DIR_FileSize, (DWORD)fp->obj.objsize); /* Update file size */
|
||||
st_dword(dir + DIR_ModTime, tm); /* Update modified time */
|
||||
st_word(dir + DIR_LstAccDate, 0);
|
||||
fs->wflag = 1;
|
||||
res = sync_fs(fs); /* Restore it to the directory */
|
||||
fp->flag &= (BYTE)~FA_MODIFIED;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Close File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_close (
|
||||
FIL* fp /* Pointer to the file object to be closed */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
res = f_sync(fp); /* Flush cached data */
|
||||
if (res == FR_OK)
|
||||
#endif
|
||||
{
|
||||
res = validate(&fp->obj, &fs); /* Lock volume */
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_LOCK != 0
|
||||
res = dec_lock(fp->obj.lockid); /* Decrement file open counter */
|
||||
if (res == FR_OK) fp->obj.fs = 0; /* Invalidate file object */
|
||||
#else
|
||||
fp->obj.fs = 0; /* Invalidate file object */
|
||||
#endif
|
||||
#if FF_FS_REENTRANT
|
||||
unlock_fs(fs, FR_OK); /* Unlock volume */
|
||||
#endif
|
||||
}
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if FF_FS_RPATH >= 1
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Change Current Directory or Current Drive, Get Current Directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
#if FF_VOLUMES >= 2
|
||||
FRESULT f_chdrive (
|
||||
const TCHAR* path /* Drive number */
|
||||
)
|
||||
{
|
||||
int vol;
|
||||
|
||||
|
||||
/* Get logical drive number */
|
||||
vol = get_ldnumber(&path);
|
||||
if (vol < 0) return FR_INVALID_DRIVE;
|
||||
|
||||
CurrVol = (BYTE)vol; /* Set it as current volume */
|
||||
|
||||
return FR_OK;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
FRESULT f_chdir (
|
||||
const TCHAR* path /* Pointer to the directory path */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
DEF_NAMBUF
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &fs, 0);
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&dj, path); /* Follow the path */
|
||||
if (res == FR_OK) { /* Follow completed */
|
||||
if (dj.fn[NSFLAG] & NS_NONAME) {
|
||||
fs->cdir = dj.obj.sclust; /* It is the start directory itself */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
fs->cdc_scl = dj.obj.c_scl;
|
||||
fs->cdc_size = dj.obj.c_size;
|
||||
fs->cdc_ofs = dj.obj.c_ofs;
|
||||
}
|
||||
#endif
|
||||
} else {
|
||||
if (dj.obj.attr & AM_DIR) { /* It is a sub-directory */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
fs->cdir = ld_dword(fs->dirbuf + XDIR_FstClus); /* Sub-directory cluster */
|
||||
fs->cdc_scl = dj.obj.sclust; /* Save containing directory information */
|
||||
fs->cdc_size = ((DWORD)dj.obj.objsize & 0xFFFFFF00) | dj.obj.stat;
|
||||
fs->cdc_ofs = dj.blk_ofs;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
fs->cdir = ld_clust(fs, dj.dir); /* Sub-directory cluster */
|
||||
}
|
||||
} else {
|
||||
res = FR_NO_PATH; /* Reached but a file */
|
||||
}
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
if (res == FR_NO_FILE) res = FR_NO_PATH;
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
#if FF_FS_RPATH >= 2
|
||||
FRESULT f_getcwd (
|
||||
TCHAR* buff, /* Pointer to the directory path */
|
||||
UINT len /* Size of path */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
UINT i, n;
|
||||
DWORD ccl;
|
||||
TCHAR *tp;
|
||||
FILINFO fno;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
*buff = 0;
|
||||
/* Get logical drive */
|
||||
res = find_volume((const TCHAR**)&buff, &fs, 0); /* Get current volume */
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
i = len; /* Bottom of buffer (directory stack base) */
|
||||
if (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT) { /* (Cannot do getcwd on exFAT and returns root path) */
|
||||
dj.obj.sclust = fs->cdir; /* Start to follow upper directory from current directory */
|
||||
while ((ccl = dj.obj.sclust) != 0) { /* Repeat while current directory is a sub-directory */
|
||||
res = dir_sdi(&dj, 1 * SZDIRE); /* Get parent directory */
|
||||
if (res != FR_OK) break;
|
||||
res = move_window(fs, dj.sect);
|
||||
if (res != FR_OK) break;
|
||||
dj.obj.sclust = ld_clust(fs, dj.dir); /* Goto parent directory */
|
||||
res = dir_sdi(&dj, 0);
|
||||
if (res != FR_OK) break;
|
||||
do { /* Find the entry links to the child directory */
|
||||
res = dir_read(&dj, 0);
|
||||
if (res != FR_OK) break;
|
||||
if (ccl == ld_clust(fs, dj.dir)) break; /* Found the entry */
|
||||
res = dir_next(&dj, 0);
|
||||
} while (res == FR_OK);
|
||||
if (res == FR_NO_FILE) res = FR_INT_ERR;/* It cannot be 'not found'. */
|
||||
if (res != FR_OK) break;
|
||||
get_fileinfo(&dj, &fno); /* Get the directory name and push it to the buffer */
|
||||
for (n = 0; fno.fname[n]; n++) ;
|
||||
if (i < n + 3) {
|
||||
res = FR_NOT_ENOUGH_CORE; break;
|
||||
}
|
||||
while (n) buff[--i] = fno.fname[--n];
|
||||
buff[--i] = '/';
|
||||
}
|
||||
}
|
||||
tp = buff;
|
||||
if (res == FR_OK) {
|
||||
#if FF_VOLUMES >= 2
|
||||
*tp++ = '0' + CurrVol; /* Put drive number */
|
||||
*tp++ = ':';
|
||||
#endif
|
||||
if (i == len) { /* Root-directory */
|
||||
*tp++ = '/';
|
||||
} else { /* Sub-directroy */
|
||||
do /* Add stacked path str */
|
||||
*tp++ = buff[i++];
|
||||
while (i < len);
|
||||
}
|
||||
}
|
||||
*tp = 0;
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
#endif /* FF_FS_RPATH >= 2 */
|
||||
#endif /* FF_FS_RPATH >= 1 */
|
||||
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE <= 2
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Seek File Read/Write Pointer */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_lseek (
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
FSIZE_t ofs /* File pointer from top of file */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD clst, bcs, nsect;
|
||||
FSIZE_t ifptr;
|
||||
#if FF_USE_FASTSEEK
|
||||
DWORD cl, pcl, ncl, tcl, dsc, tlen, ulen, *tbl;
|
||||
#endif
|
||||
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res == FR_OK) res = (FRESULT)fp->err;
|
||||
#if FF_FS_EXFAT && !FF_FS_READONLY
|
||||
if (res == FR_OK && fs->fs_type == FS_EXFAT) {
|
||||
res = fill_last_frag(&fp->obj, fp->clust, 0xFFFFFFFF); /* Fill last fragment on the FAT if needed */
|
||||
}
|
||||
#endif
|
||||
if (res != FR_OK) LEAVE_FF(fs, res);
|
||||
|
||||
#if FF_USE_FASTSEEK
|
||||
if (fp->cltbl) { /* Fast seek */
|
||||
if (ofs == CREATE_LINKMAP) { /* Create CLMT */
|
||||
tbl = fp->cltbl;
|
||||
tlen = *tbl++; ulen = 2; /* Given table size and required table size */
|
||||
cl = fp->obj.sclust; /* Origin of the chain */
|
||||
if (cl != 0) {
|
||||
do {
|
||||
/* Get a fragment */
|
||||
tcl = cl; ncl = 0; ulen += 2; /* Top, length and used items */
|
||||
do {
|
||||
pcl = cl; ncl++;
|
||||
cl = get_fat(&fp->obj, cl);
|
||||
if (cl <= 1) ABORT(fs, FR_INT_ERR);
|
||||
if (cl == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
|
||||
} while (cl == pcl + 1);
|
||||
if (ulen <= tlen) { /* Store the length and top of the fragment */
|
||||
*tbl++ = ncl; *tbl++ = tcl;
|
||||
}
|
||||
} while (cl < fs->n_fatent); /* Repeat until end of chain */
|
||||
}
|
||||
*fp->cltbl = ulen; /* Number of items used */
|
||||
if (ulen <= tlen) {
|
||||
*tbl = 0; /* Terminate table */
|
||||
} else {
|
||||
res = FR_NOT_ENOUGH_CORE; /* Given table size is smaller than required */
|
||||
}
|
||||
} else { /* Fast seek */
|
||||
if (ofs > fp->obj.objsize) ofs = fp->obj.objsize; /* Clip offset at the file size */
|
||||
fp->fptr = ofs; /* Set file pointer */
|
||||
if (ofs > 0) {
|
||||
fp->clust = clmt_clust(fp, ofs - 1);
|
||||
dsc = clst2sect(fs, fp->clust);
|
||||
if (dsc == 0) ABORT(fs, FR_INT_ERR);
|
||||
dsc += (DWORD)((ofs - 1) / SS(fs)) & (fs->csize - 1);
|
||||
if (fp->fptr % SS(fs) && dsc != fp->sect) { /* Refill sector cache if needed */
|
||||
#if !FF_FS_TINY
|
||||
#if !FF_FS_READONLY
|
||||
if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
if (disk_read(fs->pdrv, fp->buf, dsc, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); /* Load current sector */
|
||||
#endif
|
||||
fp->sect = dsc;
|
||||
}
|
||||
}
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
|
||||
/* Normal Seek */
|
||||
{
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type != FS_EXFAT && ofs >= 0x100000000) ofs = 0xFFFFFFFF; /* Clip at 4 GiB - 1 if at FATxx */
|
||||
#endif
|
||||
if (ofs > fp->obj.objsize && (FF_FS_READONLY || !(fp->flag & FA_WRITE))) { /* In read-only mode, clip offset with the file size */
|
||||
ofs = fp->obj.objsize;
|
||||
}
|
||||
ifptr = fp->fptr;
|
||||
fp->fptr = nsect = 0;
|
||||
if (ofs > 0) {
|
||||
bcs = (DWORD)fs->csize * SS(fs); /* Cluster size (byte) */
|
||||
if (ifptr > 0 &&
|
||||
(ofs - 1) / bcs >= (ifptr - 1) / bcs) { /* When seek to same or following cluster, */
|
||||
fp->fptr = (ifptr - 1) & ~(FSIZE_t)(bcs - 1); /* start from the current cluster */
|
||||
ofs -= fp->fptr;
|
||||
clst = fp->clust;
|
||||
} else { /* When seek to back cluster, */
|
||||
clst = fp->obj.sclust; /* start from the first cluster */
|
||||
#if !FF_FS_READONLY
|
||||
if (clst == 0) { /* If no cluster chain, create a new chain */
|
||||
clst = create_chain(&fp->obj, 0);
|
||||
if (clst == 1) ABORT(fs, FR_INT_ERR);
|
||||
if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
|
||||
fp->obj.sclust = clst;
|
||||
}
|
||||
#endif
|
||||
fp->clust = clst;
|
||||
}
|
||||
if (clst != 0) {
|
||||
while (ofs > bcs) { /* Cluster following loop */
|
||||
ofs -= bcs; fp->fptr += bcs;
|
||||
#if !FF_FS_READONLY
|
||||
if (fp->flag & FA_WRITE) { /* Check if in write mode or not */
|
||||
if (FF_FS_EXFAT && fp->fptr > fp->obj.objsize) { /* No FAT chain object needs correct objsize to generate FAT value */
|
||||
fp->obj.objsize = fp->fptr;
|
||||
fp->flag |= FA_MODIFIED;
|
||||
}
|
||||
clst = create_chain(&fp->obj, clst); /* Follow chain with forceed stretch */
|
||||
if (clst == 0) { /* Clip file size in case of disk full */
|
||||
ofs = 0; break;
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
clst = get_fat(&fp->obj, clst); /* Follow cluster chain if not in write mode */
|
||||
}
|
||||
if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
|
||||
if (clst <= 1 || clst >= fs->n_fatent) ABORT(fs, FR_INT_ERR);
|
||||
fp->clust = clst;
|
||||
}
|
||||
fp->fptr += ofs;
|
||||
if (ofs % SS(fs)) {
|
||||
nsect = clst2sect(fs, clst); /* Current sector */
|
||||
if (nsect == 0) ABORT(fs, FR_INT_ERR);
|
||||
nsect += (DWORD)(ofs / SS(fs));
|
||||
}
|
||||
}
|
||||
}
|
||||
if (!FF_FS_READONLY && fp->fptr > fp->obj.objsize) { /* Set file change flag if the file size is extended */
|
||||
fp->obj.objsize = fp->fptr;
|
||||
fp->flag |= FA_MODIFIED;
|
||||
}
|
||||
if (fp->fptr % SS(fs) && nsect != fp->sect) { /* Fill sector cache if needed */
|
||||
#if !FF_FS_TINY
|
||||
#if !FF_FS_READONLY
|
||||
if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
if (disk_read(fs->pdrv, fp->buf, nsect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR); /* Fill sector cache */
|
||||
#endif
|
||||
fp->sect = nsect;
|
||||
}
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE <= 1
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Create a Directory Object */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_opendir (
|
||||
DIR* dp, /* Pointer to directory object to create */
|
||||
const TCHAR* path /* Pointer to the directory path */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
if (!dp) return FR_INVALID_OBJECT;
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &fs, 0);
|
||||
if (res == FR_OK) {
|
||||
dp->obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(dp, path); /* Follow the path to the directory */
|
||||
if (res == FR_OK) { /* Follow completed */
|
||||
if (!(dp->fn[NSFLAG] & NS_NONAME)) { /* It is not the origin directory itself */
|
||||
if (dp->obj.attr & AM_DIR) { /* This object is a sub-directory */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
dp->obj.c_scl = dp->obj.sclust; /* Get containing directory inforamation */
|
||||
dp->obj.c_size = ((DWORD)dp->obj.objsize & 0xFFFFFF00) | dp->obj.stat;
|
||||
dp->obj.c_ofs = dp->blk_ofs;
|
||||
dp->obj.sclust = ld_dword(fs->dirbuf + XDIR_FstClus); /* Get object allocation info */
|
||||
dp->obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
|
||||
dp->obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
dp->obj.sclust = ld_clust(fs, dp->dir); /* Get object allocation info */
|
||||
}
|
||||
} else { /* This object is a file */
|
||||
res = FR_NO_PATH;
|
||||
}
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
dp->obj.id = fs->id;
|
||||
res = dir_sdi(dp, 0); /* Rewind directory */
|
||||
#if FF_FS_LOCK != 0
|
||||
if (res == FR_OK) {
|
||||
if (dp->obj.sclust != 0) {
|
||||
dp->obj.lockid = inc_lock(dp, 0); /* Lock the sub directory */
|
||||
if (!dp->obj.lockid) res = FR_TOO_MANY_OPEN_FILES;
|
||||
} else {
|
||||
dp->obj.lockid = 0; /* Root directory need not to be locked */
|
||||
}
|
||||
}
|
||||
#endif
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
if (res == FR_NO_FILE) res = FR_NO_PATH;
|
||||
}
|
||||
if (res != FR_OK) dp->obj.fs = 0; /* Invalidate the directory object if function faild */
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Close Directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_closedir (
|
||||
DIR *dp /* Pointer to the directory object to be closed */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
|
||||
|
||||
res = validate(&dp->obj, &fs); /* Check validity of the file object */
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_LOCK != 0
|
||||
if (dp->obj.lockid) res = dec_lock(dp->obj.lockid); /* Decrement sub-directory open counter */
|
||||
if (res == FR_OK) dp->obj.fs = 0; /* Invalidate directory object */
|
||||
#else
|
||||
dp->obj.fs = 0; /* Invalidate directory object */
|
||||
#endif
|
||||
#if FF_FS_REENTRANT
|
||||
unlock_fs(fs, FR_OK); /* Unlock volume */
|
||||
#endif
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Read Directory Entries in Sequence */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_readdir (
|
||||
DIR* dp, /* Pointer to the open directory object */
|
||||
FILINFO* fno /* Pointer to file information to return */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
res = validate(&dp->obj, &fs); /* Check validity of the directory object */
|
||||
if (res == FR_OK) {
|
||||
if (!fno) {
|
||||
res = dir_sdi(dp, 0); /* Rewind the directory object */
|
||||
} else {
|
||||
INIT_NAMBUF(fs);
|
||||
res = dir_read(dp, 0); /* Read an item */
|
||||
if (res == FR_NO_FILE) res = FR_OK; /* Ignore end of directory */
|
||||
if (res == FR_OK) { /* A valid entry is found */
|
||||
get_fileinfo(dp, fno); /* Get the object information */
|
||||
res = dir_next(dp, 0); /* Increment index for next */
|
||||
if (res == FR_NO_FILE) res = FR_OK; /* Ignore end of directory now */
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
}
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
#if FF_USE_FIND
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Find Next File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_findnext (
|
||||
DIR* dp, /* Pointer to the open directory object */
|
||||
FILINFO* fno /* Pointer to the file information structure */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
|
||||
|
||||
for (;;) {
|
||||
res = f_readdir(dp, fno); /* Get a directory item */
|
||||
if (res != FR_OK || !fno || !fno->fname[0]) break; /* Terminate if any error or end of directory */
|
||||
if (pattern_matching(dp->pat, fno->fname, 0, 0)) break; /* Test for the file name */
|
||||
#if FF_USE_LFN && FF_USE_FIND == 2
|
||||
if (pattern_matching(dp->pat, fno->altname, 0, 0)) break; /* Test for alternative name if exist */
|
||||
#endif
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Find First File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_findfirst (
|
||||
DIR* dp, /* Pointer to the blank directory object */
|
||||
FILINFO* fno, /* Pointer to the file information structure */
|
||||
const TCHAR* path, /* Pointer to the directory to open */
|
||||
const TCHAR* pattern /* Pointer to the matching pattern */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
|
||||
|
||||
dp->pat = pattern; /* Save pointer to pattern string */
|
||||
res = f_opendir(dp, path); /* Open the target directory */
|
||||
if (res == FR_OK) {
|
||||
res = f_findnext(dp, fno); /* Find the first item */
|
||||
}
|
||||
return res;
|
||||
}
|
||||
|
||||
#endif /* FF_USE_FIND */
|
||||
|
||||
|
||||
|
||||
#if FF_FS_MINIMIZE == 0
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get File Status */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_stat (
|
||||
const TCHAR* path, /* Pointer to the file path */
|
||||
FILINFO* fno /* Pointer to file information to return */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &dj.obj.fs, 0);
|
||||
if (res == FR_OK) {
|
||||
INIT_NAMBUF(dj.obj.fs);
|
||||
res = follow_path(&dj, path); /* Follow the file path */
|
||||
if (res == FR_OK) { /* Follow completed */
|
||||
if (dj.fn[NSFLAG] & NS_NONAME) { /* It is origin directory */
|
||||
res = FR_INVALID_NAME;
|
||||
} else { /* Found an object */
|
||||
if (fno) get_fileinfo(&dj, fno);
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(dj.obj.fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get Number of Free Clusters */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_getfree (
|
||||
const TCHAR* path, /* Path name of the logical drive number */
|
||||
DWORD* nclst, /* Pointer to a variable to return number of free clusters */
|
||||
FATFS** fatfs /* Pointer to return pointer to corresponding filesystem object */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD nfree, clst, sect, stat;
|
||||
UINT i;
|
||||
FFOBJID obj;
|
||||
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &fs, 0);
|
||||
if (res == FR_OK) {
|
||||
*fatfs = fs; /* Return ptr to the fs object */
|
||||
/* If free_clst is valid, return it without full FAT scan */
|
||||
if (fs->free_clst <= fs->n_fatent - 2) {
|
||||
*nclst = fs->free_clst;
|
||||
} else {
|
||||
/* Scan FAT to obtain number of free clusters */
|
||||
nfree = 0;
|
||||
if (fs->fs_type == FS_FAT12) { /* FAT12: Scan bit field FAT entries */
|
||||
clst = 2; obj.fs = fs;
|
||||
do {
|
||||
stat = get_fat(&obj, clst);
|
||||
if (stat == 0xFFFFFFFF) { res = FR_DISK_ERR; break; }
|
||||
if (stat == 1) { res = FR_INT_ERR; break; }
|
||||
if (stat == 0) nfree++;
|
||||
} while (++clst < fs->n_fatent);
|
||||
} else {
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* exFAT: Scan allocation bitmap */
|
||||
BYTE bm;
|
||||
UINT b;
|
||||
|
||||
clst = fs->n_fatent - 2; /* Number of clusters */
|
||||
sect = fs->database; /* Assuming bitmap starts at cluster 2 */
|
||||
i = 0; /* Offset in the sector */
|
||||
do { /* Counts numbuer of bits with zero in the bitmap */
|
||||
if (i == 0) {
|
||||
res = move_window(fs, sect++);
|
||||
if (res != FR_OK) break;
|
||||
}
|
||||
for (b = 8, bm = fs->win[i]; b && clst; b--, clst--) {
|
||||
if (!(bm & 1)) nfree++;
|
||||
bm >>= 1;
|
||||
}
|
||||
i = (i + 1) % SS(fs);
|
||||
} while (clst);
|
||||
} else
|
||||
#endif
|
||||
{ /* FAT16/32: Scan WORD/DWORD FAT entries */
|
||||
clst = fs->n_fatent; /* Number of entries */
|
||||
sect = fs->fatbase; /* Top of the FAT */
|
||||
i = 0; /* Offset in the sector */
|
||||
do { /* Counts numbuer of entries with zero in the FAT */
|
||||
if (i == 0) {
|
||||
res = move_window(fs, sect++);
|
||||
if (res != FR_OK) break;
|
||||
}
|
||||
if (fs->fs_type == FS_FAT16) {
|
||||
if (ld_word(fs->win + i) == 0) nfree++;
|
||||
i += 2;
|
||||
} else {
|
||||
if ((ld_dword(fs->win + i) & 0x0FFFFFFF) == 0) nfree++;
|
||||
i += 4;
|
||||
}
|
||||
i %= SS(fs);
|
||||
} while (--clst);
|
||||
}
|
||||
}
|
||||
*nclst = nfree; /* Return the free clusters */
|
||||
fs->free_clst = nfree; /* Now free_clst is valid */
|
||||
fs->fsi_flag |= 1; /* FAT32: FSInfo is to be updated */
|
||||
}
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Truncate File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_truncate (
|
||||
FIL* fp /* Pointer to the file object */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD ncl;
|
||||
|
||||
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
|
||||
if (!(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */
|
||||
|
||||
if (fp->fptr < fp->obj.objsize) { /* Process when fptr is not on the eof */
|
||||
if (fp->fptr == 0) { /* When set file size to zero, remove entire cluster chain */
|
||||
res = remove_chain(&fp->obj, fp->obj.sclust, 0);
|
||||
fp->obj.sclust = 0;
|
||||
} else { /* When truncate a part of the file, remove remaining clusters */
|
||||
ncl = get_fat(&fp->obj, fp->clust);
|
||||
res = FR_OK;
|
||||
if (ncl == 0xFFFFFFFF) res = FR_DISK_ERR;
|
||||
if (ncl == 1) res = FR_INT_ERR;
|
||||
if (res == FR_OK && ncl < fs->n_fatent) {
|
||||
res = remove_chain(&fp->obj, ncl, fp->clust);
|
||||
}
|
||||
}
|
||||
fp->obj.objsize = fp->fptr; /* Set file size to current read/write point */
|
||||
fp->flag |= FA_MODIFIED;
|
||||
#if !FF_FS_TINY
|
||||
if (res == FR_OK && (fp->flag & FA_DIRTY)) {
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) {
|
||||
res = FR_DISK_ERR;
|
||||
} else {
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
if (res != FR_OK) ABORT(fs, res);
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Delete a File/Directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_unlink (
|
||||
const TCHAR* path /* Pointer to the file or directory path */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj, sdj;
|
||||
DWORD dclst = 0;
|
||||
FATFS *fs;
|
||||
#if FF_FS_EXFAT
|
||||
FFOBJID obj;
|
||||
#endif
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &fs, FA_WRITE);
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&dj, path); /* Follow the file path */
|
||||
if (FF_FS_RPATH && res == FR_OK && (dj.fn[NSFLAG] & NS_DOT)) {
|
||||
res = FR_INVALID_NAME; /* Cannot remove dot entry */
|
||||
}
|
||||
#if FF_FS_LOCK != 0
|
||||
if (res == FR_OK) res = chk_lock(&dj, 2); /* Check if it is an open object */
|
||||
#endif
|
||||
if (res == FR_OK) { /* The object is accessible */
|
||||
if (dj.fn[NSFLAG] & NS_NONAME) {
|
||||
res = FR_INVALID_NAME; /* Cannot remove the origin directory */
|
||||
} else {
|
||||
if (dj.obj.attr & AM_RDO) {
|
||||
res = FR_DENIED; /* Cannot remove R/O object */
|
||||
}
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_EXFAT
|
||||
obj.fs = fs;
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
obj.sclust = dclst = ld_dword(fs->dirbuf + XDIR_FstClus);
|
||||
obj.objsize = ld_qword(fs->dirbuf + XDIR_FileSize);
|
||||
obj.stat = fs->dirbuf[XDIR_GenFlags] & 2;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
dclst = ld_clust(fs, dj.dir);
|
||||
}
|
||||
if (dj.obj.attr & AM_DIR) { /* Is it a sub-directory? */
|
||||
#if FF_FS_RPATH != 0
|
||||
if (dclst == fs->cdir) { /* Is it the current directory? */
|
||||
res = FR_DENIED;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
sdj.obj.fs = fs; /* Open the sub-directory */
|
||||
sdj.obj.sclust = dclst;
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
sdj.obj.objsize = obj.objsize;
|
||||
sdj.obj.stat = obj.stat;
|
||||
}
|
||||
#endif
|
||||
res = dir_sdi(&sdj, 0);
|
||||
if (res == FR_OK) {
|
||||
res = dir_read(&sdj, 0); /* Read an item */
|
||||
if (res == FR_OK) res = FR_DENIED; /* Not empty? */
|
||||
if (res == FR_NO_FILE) res = FR_OK; /* Empty? */
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
res = dir_remove(&dj); /* Remove the directory entry */
|
||||
if (res == FR_OK && dclst) { /* Remove the cluster chain if exist */
|
||||
#if FF_FS_EXFAT
|
||||
res = remove_chain(&obj, dclst, 0);
|
||||
#else
|
||||
res = remove_chain(&dj.obj, dclst, 0);
|
||||
#endif
|
||||
}
|
||||
if (res == FR_OK) res = sync_fs(fs);
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Create a Directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_mkdir (
|
||||
const TCHAR* path /* Pointer to the directory path */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
BYTE *dir;
|
||||
DWORD dcl, pcl, tm;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &fs, FA_WRITE);
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&dj, path); /* Follow the file path */
|
||||
if (res == FR_OK) res = FR_EXIST; /* Any object with same name is already existing */
|
||||
if (FF_FS_RPATH && res == FR_NO_FILE && (dj.fn[NSFLAG] & NS_DOT)) {
|
||||
res = FR_INVALID_NAME;
|
||||
}
|
||||
if (res == FR_NO_FILE) { /* Can create a new directory */
|
||||
dcl = create_chain(&dj.obj, 0); /* Allocate a cluster for the new directory table */
|
||||
dj.obj.objsize = (DWORD)fs->csize * SS(fs);
|
||||
res = FR_OK;
|
||||
if (dcl == 0) res = FR_DENIED; /* No space to allocate a new cluster */
|
||||
if (dcl == 1) res = FR_INT_ERR;
|
||||
if (dcl == 0xFFFFFFFF) res = FR_DISK_ERR;
|
||||
if (res == FR_OK) res = sync_window(fs); /* Flush FAT */
|
||||
tm = GET_FATTIME();
|
||||
if (res == FR_OK) { /* Initialize the new directory table */
|
||||
res = dir_clear(fs, dcl); /* Clean up the new table */
|
||||
if (res == FR_OK && (!FF_FS_EXFAT || fs->fs_type != FS_EXFAT)) { /* Create dot entries (FAT only) */
|
||||
dir = fs->win;
|
||||
mem_set(dir + DIR_Name, ' ', 11); /* Create "." entry */
|
||||
dir[DIR_Name] = '.';
|
||||
dir[DIR_Attr] = AM_DIR;
|
||||
st_dword(dir + DIR_ModTime, tm);
|
||||
st_clust(fs, dir, dcl);
|
||||
mem_cpy(dir + SZDIRE, dir, SZDIRE); /* Create ".." entry */
|
||||
dir[SZDIRE + 1] = '.'; pcl = dj.obj.sclust;
|
||||
st_clust(fs, dir + SZDIRE, pcl);
|
||||
fs->wflag = 1;
|
||||
}
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
res = dir_register(&dj); /* Register the object to the directoy */
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* Initialize directory entry block */
|
||||
st_dword(fs->dirbuf + XDIR_ModTime, tm); /* Created time */
|
||||
st_dword(fs->dirbuf + XDIR_FstClus, dcl); /* Table start cluster */
|
||||
st_dword(fs->dirbuf + XDIR_FileSize, (DWORD)dj.obj.objsize); /* File size needs to be valid */
|
||||
st_dword(fs->dirbuf + XDIR_ValidFileSize, (DWORD)dj.obj.objsize);
|
||||
fs->dirbuf[XDIR_GenFlags] = 3; /* Initialize the object flag */
|
||||
fs->dirbuf[XDIR_Attr] = AM_DIR; /* Attribute */
|
||||
res = store_xdir(&dj);
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
dir = dj.dir;
|
||||
st_dword(dir + DIR_ModTime, tm); /* Created time */
|
||||
st_clust(fs, dir, dcl); /* Table start cluster */
|
||||
dir[DIR_Attr] = AM_DIR; /* Attribute */
|
||||
fs->wflag = 1;
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
res = sync_fs(fs);
|
||||
}
|
||||
} else {
|
||||
remove_chain(&dj.obj, dcl, 0); /* Could not register, remove cluster chain */
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Rename a File/Directory */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_rename (
|
||||
const TCHAR* path_old, /* Pointer to the object name to be renamed */
|
||||
const TCHAR* path_new /* Pointer to the new name */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR djo, djn;
|
||||
FATFS *fs;
|
||||
BYTE buf[FF_FS_EXFAT ? SZDIRE * 2 : SZDIRE], *dir;
|
||||
DWORD dw;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
get_ldnumber(&path_new); /* Snip the drive number of new name off */
|
||||
res = find_volume(&path_old, &fs, FA_WRITE); /* Get logical drive of the old object */
|
||||
if (res == FR_OK) {
|
||||
djo.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&djo, path_old); /* Check old object */
|
||||
if (res == FR_OK && (djo.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME; /* Check validity of name */
|
||||
#if FF_FS_LOCK != 0
|
||||
if (res == FR_OK) {
|
||||
res = chk_lock(&djo, 2);
|
||||
}
|
||||
#endif
|
||||
if (res == FR_OK) { /* Object to be renamed is found */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* At exFAT volume */
|
||||
BYTE nf, nn;
|
||||
WORD nh;
|
||||
|
||||
mem_cpy(buf, fs->dirbuf, SZDIRE * 2); /* Save 85+C0 entry of old object */
|
||||
mem_cpy(&djn, &djo, sizeof djo);
|
||||
res = follow_path(&djn, path_new); /* Make sure if new object name is not in use */
|
||||
if (res == FR_OK) { /* Is new name already in use by any other object? */
|
||||
res = (djn.obj.sclust == djo.obj.sclust && djn.dptr == djo.dptr) ? FR_NO_FILE : FR_EXIST;
|
||||
}
|
||||
if (res == FR_NO_FILE) { /* It is a valid path and no name collision */
|
||||
res = dir_register(&djn); /* Register the new entry */
|
||||
if (res == FR_OK) {
|
||||
nf = fs->dirbuf[XDIR_NumSec]; nn = fs->dirbuf[XDIR_NumName];
|
||||
nh = ld_word(fs->dirbuf + XDIR_NameHash);
|
||||
mem_cpy(fs->dirbuf, buf, SZDIRE * 2); /* Restore 85+C0 entry */
|
||||
fs->dirbuf[XDIR_NumSec] = nf; fs->dirbuf[XDIR_NumName] = nn;
|
||||
st_word(fs->dirbuf + XDIR_NameHash, nh);
|
||||
if (!(fs->dirbuf[XDIR_Attr] & AM_DIR)) fs->dirbuf[XDIR_Attr] |= AM_ARC; /* Set archive attribute if it is a file */
|
||||
/* Start of critical section where an interruption can cause a cross-link */
|
||||
res = store_xdir(&djn);
|
||||
}
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{ /* At FAT/FAT32 volume */
|
||||
mem_cpy(buf, djo.dir, SZDIRE); /* Save directory entry of the object */
|
||||
mem_cpy(&djn, &djo, sizeof (DIR)); /* Duplicate the directory object */
|
||||
res = follow_path(&djn, path_new); /* Make sure if new object name is not in use */
|
||||
if (res == FR_OK) { /* Is new name already in use by any other object? */
|
||||
res = (djn.obj.sclust == djo.obj.sclust && djn.dptr == djo.dptr) ? FR_NO_FILE : FR_EXIST;
|
||||
}
|
||||
if (res == FR_NO_FILE) { /* It is a valid path and no name collision */
|
||||
res = dir_register(&djn); /* Register the new entry */
|
||||
if (res == FR_OK) {
|
||||
dir = djn.dir; /* Copy directory entry of the object except name */
|
||||
mem_cpy(dir + 13, buf + 13, SZDIRE - 13);
|
||||
dir[DIR_Attr] = buf[DIR_Attr];
|
||||
if (!(dir[DIR_Attr] & AM_DIR)) dir[DIR_Attr] |= AM_ARC; /* Set archive attribute if it is a file */
|
||||
fs->wflag = 1;
|
||||
if ((dir[DIR_Attr] & AM_DIR) && djo.obj.sclust != djn.obj.sclust) { /* Update .. entry in the sub-directory if needed */
|
||||
dw = clst2sect(fs, ld_clust(fs, dir));
|
||||
if (dw == 0) {
|
||||
res = FR_INT_ERR;
|
||||
} else {
|
||||
/* Start of critical section where an interruption can cause a cross-link */
|
||||
res = move_window(fs, dw);
|
||||
dir = fs->win + SZDIRE * 1; /* Ptr to .. entry */
|
||||
if (res == FR_OK && dir[1] == '.') {
|
||||
st_clust(fs, dir, djn.obj.sclust);
|
||||
fs->wflag = 1;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
res = dir_remove(&djo); /* Remove old entry */
|
||||
if (res == FR_OK) {
|
||||
res = sync_fs(fs);
|
||||
}
|
||||
}
|
||||
/* End of the critical section */
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
#endif /* FF_FS_MINIMIZE == 0 */
|
||||
#endif /* FF_FS_MINIMIZE <= 1 */
|
||||
#endif /* FF_FS_MINIMIZE <= 2 */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_CHMOD && !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Change Attribute */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_chmod (
|
||||
const TCHAR* path, /* Pointer to the file path */
|
||||
BYTE attr, /* Attribute bits */
|
||||
BYTE mask /* Attribute mask to change */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
res = find_volume(&path, &fs, FA_WRITE); /* Get logical drive */
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&dj, path); /* Follow the file path */
|
||||
if (res == FR_OK && (dj.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME; /* Check object validity */
|
||||
if (res == FR_OK) {
|
||||
mask &= AM_RDO|AM_HID|AM_SYS|AM_ARC; /* Valid attribute mask */
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
fs->dirbuf[XDIR_Attr] = (attr & mask) | (fs->dirbuf[XDIR_Attr] & (BYTE)~mask); /* Apply attribute change */
|
||||
res = store_xdir(&dj);
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
dj.dir[DIR_Attr] = (attr & mask) | (dj.dir[DIR_Attr] & (BYTE)~mask); /* Apply attribute change */
|
||||
fs->wflag = 1;
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
res = sync_fs(fs);
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Change Timestamp */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_utime (
|
||||
const TCHAR* path, /* Pointer to the file/directory name */
|
||||
const FILINFO* fno /* Pointer to the timestamp to be set */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
DEF_NAMBUF
|
||||
|
||||
|
||||
res = find_volume(&path, &fs, FA_WRITE); /* Get logical drive */
|
||||
if (res == FR_OK) {
|
||||
dj.obj.fs = fs;
|
||||
INIT_NAMBUF(fs);
|
||||
res = follow_path(&dj, path); /* Follow the file path */
|
||||
if (res == FR_OK && (dj.fn[NSFLAG] & (NS_DOT | NS_NONAME))) res = FR_INVALID_NAME; /* Check object validity */
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
st_dword(fs->dirbuf + XDIR_ModTime, (DWORD)fno->fdate << 16 | fno->ftime);
|
||||
res = store_xdir(&dj);
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
st_dword(dj.dir + DIR_ModTime, (DWORD)fno->fdate << 16 | fno->ftime);
|
||||
fs->wflag = 1;
|
||||
}
|
||||
if (res == FR_OK) {
|
||||
res = sync_fs(fs);
|
||||
}
|
||||
}
|
||||
FREE_NAMBUF();
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
#endif /* FF_USE_CHMOD && !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_LABEL
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get Volume Label */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_getlabel (
|
||||
const TCHAR* path, /* Path name of the logical drive number */
|
||||
TCHAR* label, /* Pointer to a buffer to store the volume label */
|
||||
DWORD* vsn /* Pointer to a variable to store the volume serial number */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
UINT si, di;
|
||||
#if (FF_LFN_UNICODE && FF_USE_LFN) || FF_FS_EXFAT
|
||||
WCHAR w;
|
||||
#endif
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&path, &fs, 0);
|
||||
|
||||
/* Get volume label */
|
||||
if (res == FR_OK && label) {
|
||||
dj.obj.fs = fs; dj.obj.sclust = 0; /* Open root directory */
|
||||
res = dir_sdi(&dj, 0);
|
||||
if (res == FR_OK) {
|
||||
res = dir_read(&dj, 1); /* Find a volume label entry */
|
||||
if (res == FR_OK) {
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
for (si = di = 0; si < dj.dir[XDIR_NumLabel]; si++) { /* Extract volume label from 83 entry */
|
||||
w = ld_word(dj.dir + XDIR_Label + si * 2);
|
||||
#if !FF_LFN_UNICODE /* ANSI/OEM API */
|
||||
w = ff_uni2oem(w, CODEPAGE); /* Unicode -> OEM */
|
||||
if (w == 0) w = '?'; /* Replace wrong char with '?' */
|
||||
if (w >= 0x100) label[di++] = (char)(w >> 8);
|
||||
#endif
|
||||
label[di++] = (TCHAR)w;
|
||||
}
|
||||
label[di] = 0;
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
si = di = 0; /* Extract volume label from AM_VOL entry with code comversion */
|
||||
do {
|
||||
#if FF_LFN_UNICODE && FF_USE_LFN /* Unicode API */
|
||||
w = (si < 11) ? dj.dir[si++] : ' ';
|
||||
if (dbc_1st((BYTE)w) && si < 11 && dbc_2nd(dj.dir[si])) {
|
||||
w = w << 8 | dj.dir[si++];
|
||||
}
|
||||
label[di++] = ff_oem2uni(w, CODEPAGE); /* OEM -> Unicode */
|
||||
#else /* ANSI/OEM API */
|
||||
label[di++] = dj.dir[si++];
|
||||
#endif
|
||||
} while (di < 11);
|
||||
do { /* Truncate trailing spaces */
|
||||
label[di] = 0;
|
||||
if (di == 0) break;
|
||||
} while (label[--di] == ' ');
|
||||
}
|
||||
}
|
||||
}
|
||||
if (res == FR_NO_FILE) { /* No label entry and return nul string */
|
||||
label[0] = 0;
|
||||
res = FR_OK;
|
||||
}
|
||||
}
|
||||
|
||||
/* Get volume serial number */
|
||||
if (res == FR_OK && vsn) {
|
||||
res = move_window(fs, fs->volbase);
|
||||
if (res == FR_OK) {
|
||||
switch (fs->fs_type) {
|
||||
case FS_EXFAT:
|
||||
di = BPB_VolIDEx; break;
|
||||
|
||||
case FS_FAT32:
|
||||
di = BS_VolID32; break;
|
||||
|
||||
default:
|
||||
di = BS_VolID;
|
||||
}
|
||||
*vsn = ld_dword(fs->win + di);
|
||||
}
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Set Volume Label */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_setlabel (
|
||||
const TCHAR* label /* Pointer to the volume label to set */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
DIR dj;
|
||||
FATFS *fs;
|
||||
BYTE dirvn[22];
|
||||
UINT i, j, slen;
|
||||
WCHAR w;
|
||||
static const char badchr[] = "\"*+,.:;<=>\?[]|\x7F";
|
||||
|
||||
|
||||
/* Get logical drive */
|
||||
res = find_volume(&label, &fs, FA_WRITE);
|
||||
if (res != FR_OK) LEAVE_FF(fs, res);
|
||||
dj.obj.fs = fs;
|
||||
|
||||
/* Get length of given volume label */
|
||||
for (slen = 0; (UINT)label[slen] >= ' '; slen++) ; /* Get name length */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) { /* On the exFAT volume */
|
||||
for (i = j = 0; i < slen; ) { /* Create volume label in directory form */
|
||||
w = label[i++];
|
||||
#if !FF_LFN_UNICODE /* ANSI/OEM API */
|
||||
if (dbc_1st((BYTE)w)) {
|
||||
w = (i < slen && dbc_2nd((BYTE)label[i])) ? w << 8 | (BYTE)label[i++] : 0;
|
||||
}
|
||||
w = ff_oem2uni(w, CODEPAGE);
|
||||
#endif
|
||||
if (w == 0 || chk_chr(badchr, w) || j == 22) { /* Check validity check validity of the volume label */
|
||||
LEAVE_FF(fs, FR_INVALID_NAME);
|
||||
}
|
||||
st_word(dirvn + j, w); j += 2;
|
||||
}
|
||||
slen = j;
|
||||
} else
|
||||
#endif
|
||||
{ /* On the FAT/FAT32 volume */
|
||||
for ( ; slen && label[slen - 1] == ' '; slen--) ; /* Remove trailing spaces */
|
||||
if (slen != 0) { /* Is there a volume label to be set? */
|
||||
dirvn[0] = 0; i = j = 0; /* Create volume label in directory form */
|
||||
do {
|
||||
#if FF_LFN_UNICODE && FF_USE_LFN /* Unicode API */
|
||||
w = ff_uni2oem(ff_wtoupper(label[i++]), CODEPAGE);
|
||||
#else /* ANSI/OEM API */
|
||||
w = (BYTE)label[i++];
|
||||
if (dbc_1st((BYTE)w)) {
|
||||
w = (j < 10 && i < slen && dbc_2nd((BYTE)label[i])) ? w << 8 | (BYTE)label[i++] : 0;
|
||||
}
|
||||
#if FF_USE_LFN
|
||||
w = ff_uni2oem(ff_wtoupper(ff_oem2uni(w, CODEPAGE)), CODEPAGE);
|
||||
#else
|
||||
if (IsLower(w)) w -= 0x20; /* To upper ASCII characters */
|
||||
#if FF_CODE_PAGE == 0
|
||||
if (ExCvt && w >= 0x80) w = ExCvt[w - 0x80]; /* To upper extended characters (SBCS cfg) */
|
||||
#elif FF_CODE_PAGE < 900
|
||||
if (w >= 0x80) w = ExCvt[w - 0x80]; /* To upper extended characters (SBCS cfg) */
|
||||
#endif
|
||||
#endif
|
||||
#endif
|
||||
if (w == 0 || chk_chr(badchr, w) || j >= (UINT)((w >= 0x100) ? 10 : 11)) { /* Reject invalid characters for volume label */
|
||||
LEAVE_FF(fs, FR_INVALID_NAME);
|
||||
}
|
||||
if (w >= 0x100) dirvn[j++] = (BYTE)(w >> 8);
|
||||
dirvn[j++] = (BYTE)w;
|
||||
} while (i < slen);
|
||||
while (j < 11) dirvn[j++] = ' '; /* Fill remaining name field */
|
||||
if (dirvn[0] == DDEM) LEAVE_FF(fs, FR_INVALID_NAME); /* Reject illegal name (heading DDEM) */
|
||||
}
|
||||
}
|
||||
|
||||
/* Set volume label */
|
||||
dj.obj.sclust = 0; /* Open root directory */
|
||||
res = dir_sdi(&dj, 0);
|
||||
if (res == FR_OK) {
|
||||
res = dir_read(&dj, 1); /* Get volume label entry */
|
||||
if (res == FR_OK) {
|
||||
if (FF_FS_EXFAT && fs->fs_type == FS_EXFAT) {
|
||||
dj.dir[XDIR_NumLabel] = (BYTE)(slen / 2); /* Change the volume label */
|
||||
mem_cpy(dj.dir + XDIR_Label, dirvn, slen);
|
||||
} else {
|
||||
if (slen != 0) {
|
||||
mem_cpy(dj.dir, dirvn, 11); /* Change the volume label */
|
||||
} else {
|
||||
dj.dir[DIR_Name] = DDEM; /* Remove the volume label */
|
||||
}
|
||||
}
|
||||
fs->wflag = 1;
|
||||
res = sync_fs(fs);
|
||||
} else { /* No volume label entry or an error */
|
||||
if (res == FR_NO_FILE) {
|
||||
res = FR_OK;
|
||||
if (slen != 0) { /* Create a volume label entry */
|
||||
res = dir_alloc(&dj, 1); /* Allocate an entry */
|
||||
if (res == FR_OK) {
|
||||
mem_set(dj.dir, 0, SZDIRE); /* Clear the entry */
|
||||
if (FF_FS_EXFAT && fs->fs_type == FS_EXFAT) {
|
||||
dj.dir[XDIR_Type] = 0x83; /* Create 83 entry */
|
||||
dj.dir[XDIR_NumLabel] = (BYTE)(slen / 2);
|
||||
mem_cpy(dj.dir + XDIR_Label, dirvn, slen);
|
||||
} else {
|
||||
dj.dir[DIR_Attr] = AM_VOL; /* Create volume label entry */
|
||||
mem_cpy(dj.dir, dirvn, 11);
|
||||
}
|
||||
fs->wflag = 1;
|
||||
res = sync_fs(fs);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
#endif /* FF_USE_LABEL */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_EXPAND && !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Allocate a Contiguous Blocks to the File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_expand (
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
FSIZE_t fsz, /* File size to be expanded to */
|
||||
BYTE opt /* Operation mode 0:Find and prepare or 1:Find and allocate */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD n, clst, stcl, scl, ncl, tcl, lclst;
|
||||
|
||||
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
|
||||
if (fsz == 0 || fp->obj.objsize != 0 || !(fp->flag & FA_WRITE)) LEAVE_FF(fs, FR_DENIED);
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type != FS_EXFAT && fsz >= 0x100000000) LEAVE_FF(fs, FR_DENIED); /* Check if in size limit */
|
||||
#endif
|
||||
n = (DWORD)fs->csize * SS(fs); /* Cluster size */
|
||||
tcl = (DWORD)(fsz / n) + ((fsz & (n - 1)) ? 1 : 0); /* Number of clusters required */
|
||||
stcl = fs->last_clst; lclst = 0;
|
||||
if (stcl < 2 || stcl >= fs->n_fatent) stcl = 2;
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (fs->fs_type == FS_EXFAT) {
|
||||
scl = find_bitmap(fs, stcl, tcl); /* Find a contiguous cluster block */
|
||||
if (scl == 0) res = FR_DENIED; /* No contiguous cluster block was found */
|
||||
if (scl == 0xFFFFFFFF) res = FR_DISK_ERR;
|
||||
if (res == FR_OK) { /* A contiguous free area is found */
|
||||
if (opt) { /* Allocate it now */
|
||||
res = change_bitmap(fs, scl, tcl, 1); /* Mark the cluster block 'in use' */
|
||||
lclst = scl + tcl - 1;
|
||||
} else { /* Set it as suggested point for next allocation */
|
||||
lclst = scl - 1;
|
||||
}
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
scl = clst = stcl; ncl = 0;
|
||||
for (;;) { /* Find a contiguous cluster block */
|
||||
n = get_fat(&fp->obj, clst);
|
||||
if (++clst >= fs->n_fatent) clst = 2;
|
||||
if (n == 1) { res = FR_INT_ERR; break; }
|
||||
if (n == 0xFFFFFFFF) { res = FR_DISK_ERR; break; }
|
||||
if (n == 0) { /* Is it a free cluster? */
|
||||
if (++ncl == tcl) break; /* Break if a contiguous cluster block is found */
|
||||
} else {
|
||||
scl = clst; ncl = 0; /* Not a free cluster */
|
||||
}
|
||||
if (clst == stcl) { res = FR_DENIED; break; } /* No contiguous cluster? */
|
||||
}
|
||||
if (res == FR_OK) { /* A contiguous free area is found */
|
||||
if (opt) { /* Allocate it now */
|
||||
for (clst = scl, n = tcl; n; clst++, n--) { /* Create a cluster chain on the FAT */
|
||||
res = put_fat(fs, clst, (n == 1) ? 0xFFFFFFFF : clst + 1);
|
||||
if (res != FR_OK) break;
|
||||
lclst = clst;
|
||||
}
|
||||
} else { /* Set it as suggested point for next allocation */
|
||||
lclst = scl - 1;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
if (res == FR_OK) {
|
||||
fs->last_clst = lclst; /* Set suggested start cluster to start next */
|
||||
if (opt) { /* Is it allocated now? */
|
||||
fp->obj.sclust = scl; /* Update object allocation information */
|
||||
fp->obj.objsize = fsz;
|
||||
if (FF_FS_EXFAT) fp->obj.stat = 2; /* Set status 'contiguous chain' */
|
||||
fp->flag |= FA_MODIFIED;
|
||||
if (fs->free_clst <= fs->n_fatent - 2) { /* Update FSINFO */
|
||||
fs->free_clst -= tcl;
|
||||
fs->fsi_flag |= 1;
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, res);
|
||||
}
|
||||
|
||||
#endif /* FF_USE_EXPAND && !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_FORWARD
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Forward Data to the Stream Directly */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_forward (
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
UINT (*func)(const BYTE*,UINT), /* Pointer to the streaming function */
|
||||
UINT btf, /* Number of bytes to forward */
|
||||
UINT* bf /* Pointer to number of bytes forwarded */
|
||||
)
|
||||
{
|
||||
FRESULT res;
|
||||
FATFS *fs;
|
||||
DWORD clst, sect;
|
||||
FSIZE_t remain;
|
||||
UINT rcnt, csect;
|
||||
BYTE *dbuf;
|
||||
|
||||
|
||||
*bf = 0; /* Clear transfer byte counter */
|
||||
res = validate(&fp->obj, &fs); /* Check validity of the file object */
|
||||
if (res != FR_OK || (res = (FRESULT)fp->err) != FR_OK) LEAVE_FF(fs, res);
|
||||
if (!(fp->flag & FA_READ)) LEAVE_FF(fs, FR_DENIED); /* Check access mode */
|
||||
|
||||
remain = fp->obj.objsize - fp->fptr;
|
||||
if (btf > remain) btf = (UINT)remain; /* Truncate btf by remaining bytes */
|
||||
|
||||
for ( ; btf && (*func)(0, 0); /* Repeat until all data transferred or stream goes busy */
|
||||
fp->fptr += rcnt, *bf += rcnt, btf -= rcnt) {
|
||||
csect = (UINT)(fp->fptr / SS(fs) & (fs->csize - 1)); /* Sector offset in the cluster */
|
||||
if (fp->fptr % SS(fs) == 0) { /* On the sector boundary? */
|
||||
if (csect == 0) { /* On the cluster boundary? */
|
||||
clst = (fp->fptr == 0) ? /* On the top of the file? */
|
||||
fp->obj.sclust : get_fat(&fp->obj, fp->clust);
|
||||
if (clst <= 1) ABORT(fs, FR_INT_ERR);
|
||||
if (clst == 0xFFFFFFFF) ABORT(fs, FR_DISK_ERR);
|
||||
fp->clust = clst; /* Update current cluster */
|
||||
}
|
||||
}
|
||||
sect = clst2sect(fs, fp->clust); /* Get current data sector */
|
||||
if (sect == 0) ABORT(fs, FR_INT_ERR);
|
||||
sect += csect;
|
||||
#if FF_FS_TINY
|
||||
if (move_window(fs, sect) != FR_OK) ABORT(fs, FR_DISK_ERR); /* Move sector window to the file data */
|
||||
dbuf = fs->win;
|
||||
#else
|
||||
if (fp->sect != sect) { /* Fill sector cache with file data */
|
||||
#if !FF_FS_READONLY
|
||||
if (fp->flag & FA_DIRTY) { /* Write-back dirty sector cache */
|
||||
if (disk_write(fs->pdrv, fp->buf, fp->sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
fp->flag &= (BYTE)~FA_DIRTY;
|
||||
}
|
||||
#endif
|
||||
if (disk_read(fs->pdrv, fp->buf, sect, 1) != RES_OK) ABORT(fs, FR_DISK_ERR);
|
||||
}
|
||||
dbuf = fp->buf;
|
||||
#endif
|
||||
fp->sect = sect;
|
||||
rcnt = SS(fs) - (UINT)fp->fptr % SS(fs); /* Number of bytes left in the sector */
|
||||
if (rcnt > btf) rcnt = btf; /* Clip it by btr if needed */
|
||||
rcnt = (*func)(dbuf + ((UINT)fp->fptr % SS(fs)), rcnt); /* Forward the file data */
|
||||
if (rcnt == 0) ABORT(fs, FR_INT_ERR);
|
||||
}
|
||||
|
||||
LEAVE_FF(fs, FR_OK);
|
||||
}
|
||||
#endif /* FF_USE_FORWARD */
|
||||
|
||||
|
||||
|
||||
#if FF_USE_MKFS && !FF_FS_READONLY
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Create an FAT/exFAT volume */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_mkfs (
|
||||
const TCHAR* path, /* Logical drive number */
|
||||
BYTE opt, /* Format option */
|
||||
DWORD au, /* Size of allocation unit (cluster) [byte] */
|
||||
void* work, /* Pointer to working buffer */
|
||||
UINT len /* Size of working buffer */
|
||||
)
|
||||
{
|
||||
const UINT n_fats = 1; /* Number of FATs for FAT/FAT32 volume (1 or 2) */
|
||||
const UINT n_rootdir = 512; /* Number of root directory entries for FAT volume */
|
||||
static const WORD cst[] = {1, 4, 16, 64, 256, 512, 0}; /* Cluster size boundary for FAT volume (4Ks unit) */
|
||||
static const WORD cst32[] = {1, 2, 4, 8, 16, 32, 0}; /* Cluster size boundary for FAT32 volume (128Ks unit) */
|
||||
BYTE fmt, sys, *buf, *pte, pdrv, part;
|
||||
WORD ss;
|
||||
DWORD szb_buf, sz_buf, sz_blk, n_clst, pau, sect, nsect, n;
|
||||
DWORD b_vol, b_fat, b_data; /* Base LBA for volume, fat, data */
|
||||
DWORD sz_vol, sz_rsv, sz_fat, sz_dir; /* Size for volume, fat, dir, data */
|
||||
UINT i;
|
||||
int vol;
|
||||
DSTATUS stat;
|
||||
#if FF_USE_TRIM || FF_FS_EXFAT
|
||||
DWORD tbl[3];
|
||||
#endif
|
||||
|
||||
|
||||
/* Check mounted drive and clear work area */
|
||||
vol = get_ldnumber(&path); /* Get target logical drive */
|
||||
if (vol < 0) return FR_INVALID_DRIVE;
|
||||
if (FatFs[vol]) FatFs[vol]->fs_type = 0; /* Clear the volume */
|
||||
pdrv = LD2PD(vol); /* Physical drive */
|
||||
part = LD2PT(vol); /* Partition (0:create as new, 1-4:get from partition table) */
|
||||
|
||||
/* Check physical drive status */
|
||||
stat = disk_initialize(pdrv);
|
||||
if (stat & STA_NOINIT) return FR_NOT_READY;
|
||||
if (stat & STA_PROTECT) return FR_WRITE_PROTECTED;
|
||||
if (disk_ioctl(pdrv, GET_BLOCK_SIZE, &sz_blk) != RES_OK || !sz_blk || sz_blk > 32768 || (sz_blk & (sz_blk - 1))) sz_blk = 1; /* Erase block to align data area */
|
||||
#if FF_MAX_SS != FF_MIN_SS /* Get sector size of the medium if variable sector size cfg. */
|
||||
if (disk_ioctl(pdrv, GET_SECTOR_SIZE, &ss) != RES_OK) return FR_DISK_ERR;
|
||||
if (ss > FF_MAX_SS || ss < FF_MIN_SS || (ss & (ss - 1))) return FR_DISK_ERR;
|
||||
#else
|
||||
ss = FF_MAX_SS;
|
||||
#endif
|
||||
if ((au != 0 && au < ss) || au > 0x1000000 || (au & (au - 1))) return FR_INVALID_PARAMETER; /* Check if au is valid */
|
||||
au /= ss; /* Cluster size in unit of sector */
|
||||
|
||||
/* Get working buffer */
|
||||
buf = (BYTE*)work; /* Working buffer */
|
||||
sz_buf = len / ss; /* Size of working buffer (sector) */
|
||||
szb_buf = sz_buf * ss; /* Size of working buffer (byte) */
|
||||
if (szb_buf == 0) return FR_MKFS_ABORTED;
|
||||
|
||||
/* Determine where the volume to be located (b_vol, sz_vol) */
|
||||
if (FF_MULTI_PARTITION && part != 0) {
|
||||
/* Get partition information from partition table in the MBR */
|
||||
if (disk_read(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR; /* Load MBR */
|
||||
if (ld_word(buf + BS_55AA) != 0xAA55) return FR_MKFS_ABORTED; /* Check if MBR is valid */
|
||||
pte = buf + (MBR_Table + (part - 1) * SZ_PTE);
|
||||
if (!pte[PTE_System]) return FR_MKFS_ABORTED; /* No partition? */
|
||||
b_vol = ld_dword(pte + PTE_StLba); /* Get volume start sector */
|
||||
sz_vol = ld_dword(pte + PTE_SizLba); /* Get volume size */
|
||||
} else {
|
||||
/* Create a single-partition in this function */
|
||||
if (disk_ioctl(pdrv, GET_SECTOR_COUNT, &sz_vol) != RES_OK) return FR_DISK_ERR;
|
||||
b_vol = (opt & FM_SFD) ? 0 : 63; /* Volume start sector */
|
||||
if (sz_vol < b_vol) return FR_MKFS_ABORTED;
|
||||
sz_vol -= b_vol; /* Volume size */
|
||||
}
|
||||
if (sz_vol < 128) return FR_MKFS_ABORTED; /* Check if volume size is >=128s */
|
||||
|
||||
/* Pre-determine the FAT type */
|
||||
do {
|
||||
if (FF_FS_EXFAT && (opt & FM_EXFAT)) { /* exFAT possible? */
|
||||
if ((opt & FM_ANY) == FM_EXFAT || sz_vol >= 0x4000000 || au > 128) { /* exFAT only, vol >= 64Ms or au > 128s ? */
|
||||
fmt = FS_EXFAT; break;
|
||||
}
|
||||
}
|
||||
if (au > 128) return FR_INVALID_PARAMETER; /* Too large au for FAT/FAT32 */
|
||||
if (opt & FM_FAT32) { /* FAT32 possible? */
|
||||
if ((opt & FM_ANY) == FM_FAT32 || !(opt & FM_FAT)) { /* FAT32 only or no-FAT? */
|
||||
fmt = FS_FAT32; break;
|
||||
}
|
||||
}
|
||||
if (!(opt & FM_FAT)) return FR_INVALID_PARAMETER; /* no-FAT? */
|
||||
fmt = FS_FAT16;
|
||||
} while (0);
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
if (fmt == FS_EXFAT) { /* Create an exFAT volume */
|
||||
DWORD szb_bit, szb_case, sum, nb, cl;
|
||||
WCHAR ch, si;
|
||||
UINT j, st;
|
||||
BYTE b;
|
||||
|
||||
if (sz_vol < 0x1000) return FR_MKFS_ABORTED; /* Too small volume? */
|
||||
#if FF_USE_TRIM
|
||||
tbl[0] = b_vol; tbl[1] = b_vol + sz_vol - 1; /* Inform the device the volume area may be erased */
|
||||
disk_ioctl(pdrv, CTRL_TRIM, tbl);
|
||||
#endif
|
||||
/* Determine FAT location, data location and number of clusters */
|
||||
if (au == 0) { /* au auto-selection */
|
||||
au = 8;
|
||||
if (sz_vol >= 0x80000) au = 64; /* >= 512Ks */
|
||||
if (sz_vol >= 0x4000000) au = 256; /* >= 64Ms */
|
||||
}
|
||||
b_fat = b_vol + 32; /* FAT start at offset 32 */
|
||||
sz_fat = ((sz_vol / au + 2) * 4 + ss - 1) / ss; /* Number of FAT sectors */
|
||||
b_data = (b_fat + sz_fat + sz_blk - 1) & ~(sz_blk - 1); /* Align data area to the erase block boundary */
|
||||
if (b_data >= sz_vol / 2) return FR_MKFS_ABORTED; /* Too small volume? */
|
||||
n_clst = (sz_vol - (b_data - b_vol)) / au; /* Number of clusters */
|
||||
if (n_clst <16) return FR_MKFS_ABORTED; /* Too few clusters? */
|
||||
if (n_clst > MAX_EXFAT) return FR_MKFS_ABORTED; /* Too many clusters? */
|
||||
|
||||
szb_bit = (n_clst + 7) / 8; /* Size of allocation bitmap */
|
||||
tbl[0] = (szb_bit + au * ss - 1) / (au * ss); /* Number of allocation bitmap clusters */
|
||||
|
||||
/* Create a compressed up-case table */
|
||||
sect = b_data + au * tbl[0]; /* Table start sector */
|
||||
sum = 0; /* Table checksum to be stored in the 82 entry */
|
||||
st = si = i = j = szb_case = 0;
|
||||
do {
|
||||
switch (st) {
|
||||
case 0:
|
||||
ch = ff_wtoupper(si); /* Get an up-case char */
|
||||
if (ch != si) {
|
||||
si++; break; /* Store the up-case char if exist */
|
||||
}
|
||||
for (j = 1; (WCHAR)(si + j) && (WCHAR)(si + j) == ff_wtoupper((WCHAR)(si + j)); j++) ; /* Get run length of no-case block */
|
||||
if (j >= 128) {
|
||||
ch = 0xFFFF; st = 2; break; /* Compress the no-case block if run is >= 128 */
|
||||
}
|
||||
st = 1; /* Do not compress short run */
|
||||
/* go to next case */
|
||||
case 1:
|
||||
ch = si++; /* Fill the short run */
|
||||
if (--j == 0) st = 0;
|
||||
break;
|
||||
|
||||
default:
|
||||
ch = (WCHAR)j; si += j; /* Number of chars to skip */
|
||||
st = 0;
|
||||
}
|
||||
sum = xsum32(buf[i + 0] = (BYTE)ch, sum); /* Put it into the write buffer */
|
||||
sum = xsum32(buf[i + 1] = (BYTE)(ch >> 8), sum);
|
||||
i += 2; szb_case += 2;
|
||||
if (si == 0|| i == szb_buf) { /* Write buffered data when buffer full or end of process */
|
||||
n = (i + ss - 1) / ss;
|
||||
if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
|
||||
sect += n; i = 0;
|
||||
}
|
||||
} while (si);
|
||||
tbl[1] = (szb_case + au * ss - 1) / (au * ss); /* Number of up-case table clusters */
|
||||
tbl[2] = 1; /* Number of root dir clusters */
|
||||
|
||||
/* Initialize the allocation bitmap */
|
||||
sect = b_data; nsect = (szb_bit + ss - 1) / ss; /* Start of bitmap and number of sectors */
|
||||
nb = tbl[0] + tbl[1] + tbl[2]; /* Number of clusters in-use by system */
|
||||
do {
|
||||
mem_set(buf, 0, szb_buf);
|
||||
for (i = 0; nb >= 8 && i < szb_buf; buf[i++] = 0xFF, nb -= 8) ;
|
||||
for (b = 1; nb != 0 && i < szb_buf; buf[i] |= b, b <<= 1, nb--) ;
|
||||
n = (nsect > sz_buf) ? sz_buf : nsect; /* Write the buffered data */
|
||||
if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
|
||||
sect += n; nsect -= n;
|
||||
} while (nsect);
|
||||
|
||||
/* Initialize the FAT */
|
||||
sect = b_fat; nsect = sz_fat; /* Start of FAT and number of FAT sectors */
|
||||
j = nb = cl = 0;
|
||||
do {
|
||||
mem_set(buf, 0, szb_buf); i = 0; /* Clear work area and reset write index */
|
||||
if (cl == 0) { /* Set entry 0 and 1 */
|
||||
st_dword(buf + i, 0xFFFFFFF8); i += 4; cl++;
|
||||
st_dword(buf + i, 0xFFFFFFFF); i += 4; cl++;
|
||||
}
|
||||
do { /* Create chains of bitmap, up-case and root dir */
|
||||
while (nb != 0 && i < szb_buf) { /* Create a chain */
|
||||
st_dword(buf + i, (nb > 1) ? cl + 1 : 0xFFFFFFFF);
|
||||
i += 4; cl++; nb--;
|
||||
}
|
||||
if (nb == 0 && j < 3) nb = tbl[j++]; /* Next chain */
|
||||
} while (nb != 0 && i < szb_buf);
|
||||
n = (nsect > sz_buf) ? sz_buf : nsect; /* Write the buffered data */
|
||||
if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
|
||||
sect += n; nsect -= n;
|
||||
} while (nsect);
|
||||
|
||||
/* Initialize the root directory */
|
||||
mem_set(buf, 0, szb_buf);
|
||||
buf[SZDIRE * 0 + 0] = 0x83; /* 83 entry (volume label) */
|
||||
buf[SZDIRE * 1 + 0] = 0x81; /* 81 entry (allocation bitmap) */
|
||||
st_dword(buf + SZDIRE * 1 + 20, 2);
|
||||
st_dword(buf + SZDIRE * 1 + 24, szb_bit);
|
||||
buf[SZDIRE * 2 + 0] = 0x82; /* 82 entry (up-case table) */
|
||||
st_dword(buf + SZDIRE * 2 + 4, sum);
|
||||
st_dword(buf + SZDIRE * 2 + 20, 2 + tbl[0]);
|
||||
st_dword(buf + SZDIRE * 2 + 24, szb_case);
|
||||
sect = b_data + au * (tbl[0] + tbl[1]); nsect = au; /* Start of the root directory and number of sectors */
|
||||
do { /* Fill root directory sectors */
|
||||
n = (nsect > sz_buf) ? sz_buf : nsect;
|
||||
if (disk_write(pdrv, buf, sect, n) != RES_OK) return FR_DISK_ERR;
|
||||
mem_set(buf, 0, ss);
|
||||
sect += n; nsect -= n;
|
||||
} while (nsect);
|
||||
|
||||
/* Create two set of the exFAT VBR blocks */
|
||||
sect = b_vol;
|
||||
for (n = 0; n < 2; n++) {
|
||||
/* Main record (+0) */
|
||||
mem_set(buf, 0, ss);
|
||||
mem_cpy(buf + BS_JmpBoot, "\xEB\x76\x90" "EXFAT ", 11); /* Boot jump code (x86), OEM name */
|
||||
st_dword(buf + BPB_VolOfsEx, b_vol); /* Volume offset in the physical drive [sector] */
|
||||
st_dword(buf + BPB_TotSecEx, sz_vol); /* Volume size [sector] */
|
||||
st_dword(buf + BPB_FatOfsEx, b_fat - b_vol); /* FAT offset [sector] */
|
||||
st_dword(buf + BPB_FatSzEx, sz_fat); /* FAT size [sector] */
|
||||
st_dword(buf + BPB_DataOfsEx, b_data - b_vol); /* Data offset [sector] */
|
||||
st_dword(buf + BPB_NumClusEx, n_clst); /* Number of clusters */
|
||||
st_dword(buf + BPB_RootClusEx, 2 + tbl[0] + tbl[1]); /* Root dir cluster # */
|
||||
st_dword(buf + BPB_VolIDEx, GET_FATTIME()); /* VSN */
|
||||
st_word(buf + BPB_FSVerEx, 0x100); /* Filesystem version (1.00) */
|
||||
for (buf[BPB_BytsPerSecEx] = 0, i = ss; i >>= 1; buf[BPB_BytsPerSecEx]++) ; /* Log2 of sector size [byte] */
|
||||
for (buf[BPB_SecPerClusEx] = 0, i = au; i >>= 1; buf[BPB_SecPerClusEx]++) ; /* Log2 of cluster size [sector] */
|
||||
buf[BPB_NumFATsEx] = 1; /* Number of FATs */
|
||||
buf[BPB_DrvNumEx] = 0x80; /* Drive number (for int13) */
|
||||
st_word(buf + BS_BootCodeEx, 0xFEEB); /* Boot code (x86) */
|
||||
st_word(buf + BS_55AA, 0xAA55); /* Signature (placed here regardless of sector size) */
|
||||
for (i = sum = 0; i < ss; i++) { /* VBR checksum */
|
||||
if (i != BPB_VolFlagEx && i != BPB_VolFlagEx + 1 && i != BPB_PercInUseEx) sum = xsum32(buf[i], sum);
|
||||
}
|
||||
if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
|
||||
/* Extended bootstrap record (+1..+8) */
|
||||
mem_set(buf, 0, ss);
|
||||
st_word(buf + ss - 2, 0xAA55); /* Signature (placed at end of sector) */
|
||||
for (j = 1; j < 9; j++) {
|
||||
for (i = 0; i < ss; sum = xsum32(buf[i++], sum)) ; /* VBR checksum */
|
||||
if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
|
||||
}
|
||||
/* OEM/Reserved record (+9..+10) */
|
||||
mem_set(buf, 0, ss);
|
||||
for ( ; j < 11; j++) {
|
||||
for (i = 0; i < ss; sum = xsum32(buf[i++], sum)) ; /* VBR checksum */
|
||||
if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
|
||||
}
|
||||
/* Sum record (+11) */
|
||||
for (i = 0; i < ss; i += 4) st_dword(buf + i, sum); /* Fill with checksum value */
|
||||
if (disk_write(pdrv, buf, sect++, 1) != RES_OK) return FR_DISK_ERR;
|
||||
}
|
||||
|
||||
} else
|
||||
#endif /* FF_FS_EXFAT */
|
||||
{ /* Create an FAT/FAT32 volume */
|
||||
do {
|
||||
pau = au;
|
||||
/* Pre-determine number of clusters and FAT sub-type */
|
||||
if (fmt == FS_FAT32) { /* FAT32 volume */
|
||||
if (pau == 0) { /* au auto-selection */
|
||||
n = sz_vol / 0x20000; /* Volume size in unit of 128KS */
|
||||
for (i = 0, pau = 1; cst32[i] && cst32[i] <= n; i++, pau <<= 1) ; /* Get from table */
|
||||
}
|
||||
n_clst = sz_vol / pau; /* Number of clusters */
|
||||
sz_fat = (n_clst * 4 + 8 + ss - 1) / ss; /* FAT size [sector] */
|
||||
sz_rsv = 32; /* Number of reserved sectors */
|
||||
sz_dir = 0; /* No static directory */
|
||||
if (n_clst <= MAX_FAT16 || n_clst > MAX_FAT32) return FR_MKFS_ABORTED;
|
||||
} else { /* FAT volume */
|
||||
if (pau == 0) { /* au auto-selection */
|
||||
n = sz_vol / 0x1000; /* Volume size in unit of 4KS */
|
||||
for (i = 0, pau = 1; cst[i] && cst[i] <= n; i++, pau <<= 1) ; /* Get from table */
|
||||
}
|
||||
n_clst = sz_vol / pau;
|
||||
if (n_clst > MAX_FAT12) {
|
||||
n = n_clst * 2 + 4; /* FAT size [byte] */
|
||||
} else {
|
||||
fmt = FS_FAT12;
|
||||
n = (n_clst * 3 + 1) / 2 + 3; /* FAT size [byte] */
|
||||
}
|
||||
sz_fat = (n + ss - 1) / ss; /* FAT size [sector] */
|
||||
sz_rsv = 1; /* Number of reserved sectors */
|
||||
sz_dir = (DWORD)n_rootdir * SZDIRE / ss; /* Rootdir size [sector] */
|
||||
}
|
||||
b_fat = b_vol + sz_rsv; /* FAT base */
|
||||
b_data = b_fat + sz_fat * n_fats + sz_dir; /* Data base */
|
||||
|
||||
/* Align data base to erase block boundary (for flash memory media) */
|
||||
n = ((b_data + sz_blk - 1) & ~(sz_blk - 1)) - b_data; /* Next nearest erase block from current data base */
|
||||
if (fmt == FS_FAT32) { /* FAT32: Move FAT base */
|
||||
sz_rsv += n; b_fat += n;
|
||||
} else { /* FAT: Expand FAT size */
|
||||
sz_fat += n / n_fats;
|
||||
}
|
||||
|
||||
/* Determine number of clusters and final check of validity of the FAT sub-type */
|
||||
if (sz_vol < b_data + pau * 16 - b_vol) return FR_MKFS_ABORTED; /* Too small volume */
|
||||
n_clst = (sz_vol - sz_rsv - sz_fat * n_fats - sz_dir) / pau;
|
||||
if (fmt == FS_FAT32) {
|
||||
if (n_clst <= MAX_FAT16) { /* Too few clusters for FAT32 */
|
||||
if (au == 0 && (au = pau / 2) != 0) continue; /* Adjust cluster size and retry */
|
||||
return FR_MKFS_ABORTED;
|
||||
}
|
||||
}
|
||||
if (fmt == FS_FAT16) {
|
||||
if (n_clst > MAX_FAT16) { /* Too many clusters for FAT16 */
|
||||
if (au == 0 && (pau * 2) <= 64) {
|
||||
au = pau * 2; continue; /* Adjust cluster size and retry */
|
||||
}
|
||||
if ((opt & FM_FAT32)) {
|
||||
fmt = FS_FAT32; continue; /* Switch type to FAT32 and retry */
|
||||
}
|
||||
if (au == 0 && (au = pau * 2) <= 128) continue; /* Adjust cluster size and retry */
|
||||
return FR_MKFS_ABORTED;
|
||||
}
|
||||
if (n_clst <= MAX_FAT12) { /* Too few clusters for FAT16 */
|
||||
if (au == 0 && (au = pau * 2) <= 128) continue; /* Adjust cluster size and retry */
|
||||
return FR_MKFS_ABORTED;
|
||||
}
|
||||
}
|
||||
if (fmt == FS_FAT12 && n_clst > MAX_FAT12) return FR_MKFS_ABORTED; /* Too many clusters for FAT12 */
|
||||
|
||||
/* Ok, it is the valid cluster configuration */
|
||||
break;
|
||||
} while (1);
|
||||
|
||||
#if FF_USE_TRIM
|
||||
tbl[0] = b_vol; tbl[1] = b_vol + sz_vol - 1; /* Inform the device the volume area can be erased */
|
||||
disk_ioctl(pdrv, CTRL_TRIM, tbl);
|
||||
#endif
|
||||
/* Create FAT VBR */
|
||||
mem_set(buf, 0, ss);
|
||||
mem_cpy(buf + BS_JmpBoot, "\xEB\xFE\x90" "MSDOS5.0", 11);/* Boot jump code (x86), OEM name */
|
||||
st_word(buf + BPB_BytsPerSec, ss); /* Sector size [byte] */
|
||||
buf[BPB_SecPerClus] = (BYTE)pau; /* Cluster size [sector] */
|
||||
st_word(buf + BPB_RsvdSecCnt, (WORD)sz_rsv); /* Size of reserved area */
|
||||
buf[BPB_NumFATs] = (BYTE)n_fats; /* Number of FATs */
|
||||
st_word(buf + BPB_RootEntCnt, (WORD)((fmt == FS_FAT32) ? 0 : n_rootdir)); /* Number of root directory entries */
|
||||
if (sz_vol < 0x10000) {
|
||||
st_word(buf + BPB_TotSec16, (WORD)sz_vol); /* Volume size in 16-bit LBA */
|
||||
} else {
|
||||
st_dword(buf + BPB_TotSec32, sz_vol); /* Volume size in 32-bit LBA */
|
||||
}
|
||||
buf[BPB_Media] = 0xF8; /* Media descriptor byte */
|
||||
st_word(buf + BPB_SecPerTrk, 63); /* Number of sectors per track (for int13) */
|
||||
st_word(buf + BPB_NumHeads, 255); /* Number of heads (for int13) */
|
||||
st_dword(buf + BPB_HiddSec, b_vol); /* Volume offset in the physical drive [sector] */
|
||||
if (fmt == FS_FAT32) {
|
||||
st_dword(buf + BS_VolID32, GET_FATTIME()); /* VSN */
|
||||
st_dword(buf + BPB_FATSz32, sz_fat); /* FAT size [sector] */
|
||||
st_dword(buf + BPB_RootClus32, 2); /* Root directory cluster # (2) */
|
||||
st_word(buf + BPB_FSInfo32, 1); /* Offset of FSINFO sector (VBR + 1) */
|
||||
st_word(buf + BPB_BkBootSec32, 6); /* Offset of backup VBR (VBR + 6) */
|
||||
buf[BS_DrvNum32] = 0x80; /* Drive number (for int13) */
|
||||
buf[BS_BootSig32] = 0x29; /* Extended boot signature */
|
||||
mem_cpy(buf + BS_VolLab32, "NO NAME " "FAT32 ", 19); /* Volume label, FAT signature */
|
||||
} else {
|
||||
st_dword(buf + BS_VolID, GET_FATTIME()); /* VSN */
|
||||
st_word(buf + BPB_FATSz16, (WORD)sz_fat); /* FAT size [sector] */
|
||||
buf[BS_DrvNum] = 0x80; /* Drive number (for int13) */
|
||||
buf[BS_BootSig] = 0x29; /* Extended boot signature */
|
||||
mem_cpy(buf + BS_VolLab, "NO NAME " "FAT ", 19); /* Volume label, FAT signature */
|
||||
}
|
||||
st_word(buf + BS_55AA, 0xAA55); /* Signature (offset is fixed here regardless of sector size) */
|
||||
if (disk_write(pdrv, buf, b_vol, 1) != RES_OK) return FR_DISK_ERR; /* Write it to the VBR sector */
|
||||
|
||||
/* Create FSINFO record if needed */
|
||||
if (fmt == FS_FAT32) {
|
||||
disk_write(pdrv, buf, b_vol + 6, 1); /* Write backup VBR (VBR + 6) */
|
||||
mem_set(buf, 0, ss);
|
||||
st_dword(buf + FSI_LeadSig, 0x41615252);
|
||||
st_dword(buf + FSI_StrucSig, 0x61417272);
|
||||
st_dword(buf + FSI_Free_Count, n_clst - 1); /* Number of free clusters */
|
||||
st_dword(buf + FSI_Nxt_Free, 2); /* Last allocated cluster# */
|
||||
st_word(buf + BS_55AA, 0xAA55);
|
||||
disk_write(pdrv, buf, b_vol + 7, 1); /* Write backup FSINFO (VBR + 7) */
|
||||
disk_write(pdrv, buf, b_vol + 1, 1); /* Write original FSINFO (VBR + 1) */
|
||||
}
|
||||
|
||||
/* Initialize FAT area */
|
||||
mem_set(buf, 0, (UINT)szb_buf);
|
||||
sect = b_fat; /* FAT start sector */
|
||||
for (i = 0; i < n_fats; i++) { /* Initialize FATs each */
|
||||
if (fmt == FS_FAT32) {
|
||||
st_dword(buf + 0, 0xFFFFFFF8); /* Entry 0 */
|
||||
st_dword(buf + 4, 0xFFFFFFFF); /* Entry 1 */
|
||||
st_dword(buf + 8, 0x0FFFFFFF); /* Entry 2 (root directory) */
|
||||
} else {
|
||||
st_dword(buf + 0, (fmt == FS_FAT12) ? 0xFFFFF8 : 0xFFFFFFF8); /* Entry 0 and 1 */
|
||||
}
|
||||
nsect = sz_fat; /* Number of FAT sectors */
|
||||
do { /* Fill FAT sectors */
|
||||
n = (nsect > sz_buf) ? sz_buf : nsect;
|
||||
if (disk_write(pdrv, buf, sect, (UINT)n) != RES_OK) return FR_DISK_ERR;
|
||||
mem_set(buf, 0, ss);
|
||||
sect += n; nsect -= n;
|
||||
} while (nsect);
|
||||
}
|
||||
|
||||
/* Initialize root directory (fill with zero) */
|
||||
nsect = (fmt == FS_FAT32) ? pau : sz_dir; /* Number of root directory sectors */
|
||||
do {
|
||||
n = (nsect > sz_buf) ? sz_buf : nsect;
|
||||
if (disk_write(pdrv, buf, sect, (UINT)n) != RES_OK) return FR_DISK_ERR;
|
||||
sect += n; nsect -= n;
|
||||
} while (nsect);
|
||||
}
|
||||
|
||||
/* Determine system ID in the partition table */
|
||||
if (FF_FS_EXFAT && fmt == FS_EXFAT) {
|
||||
sys = 0x07; /* HPFS/NTFS/exFAT */
|
||||
} else {
|
||||
if (fmt == FS_FAT32) {
|
||||
sys = 0x0C; /* FAT32X */
|
||||
} else {
|
||||
if (sz_vol >= 0x10000) {
|
||||
sys = 0x06; /* FAT12/16 (large) */
|
||||
} else {
|
||||
sys = (fmt == FS_FAT16) ? 0x04 : 0x01; /* FAT16 : FAT12 */
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
/* Update partition information */
|
||||
if (FF_MULTI_PARTITION && part != 0) { /* Created in the existing partition */
|
||||
/* Update system ID in the partition table */
|
||||
if (disk_read(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR; /* Read the MBR */
|
||||
buf[MBR_Table + (part - 1) * SZ_PTE + PTE_System] = sys; /* Set system ID */
|
||||
if (disk_write(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR; /* Write it back to the MBR */
|
||||
} else { /* Created as a new single partition */
|
||||
if (!(opt & FM_SFD)) { /* Create partition table if in FDISK format */
|
||||
mem_set(buf, 0, ss);
|
||||
st_word(buf + BS_55AA, 0xAA55); /* MBR signature */
|
||||
pte = buf + MBR_Table; /* Create partition table for single partition in the drive */
|
||||
pte[PTE_Boot] = 0; /* Boot indicator */
|
||||
pte[PTE_StHead] = 1; /* Start head */
|
||||
pte[PTE_StSec] = 1; /* Start sector */
|
||||
pte[PTE_StCyl] = 0; /* Start cylinder */
|
||||
pte[PTE_System] = sys; /* System type */
|
||||
n = (b_vol + sz_vol) / (63 * 255); /* (End CHS may be invalid) */
|
||||
pte[PTE_EdHead] = 254; /* End head */
|
||||
pte[PTE_EdSec] = (BYTE)(n >> 2 | 63); /* End sector */
|
||||
pte[PTE_EdCyl] = (BYTE)n; /* End cylinder */
|
||||
st_dword(pte + PTE_StLba, b_vol); /* Start offset in LBA */
|
||||
st_dword(pte + PTE_SizLba, sz_vol); /* Size in sectors */
|
||||
if (disk_write(pdrv, buf, 0, 1) != RES_OK) return FR_DISK_ERR; /* Write it to the MBR */
|
||||
}
|
||||
}
|
||||
|
||||
if (disk_ioctl(pdrv, CTRL_SYNC, 0) != RES_OK) return FR_DISK_ERR;
|
||||
|
||||
return FR_OK;
|
||||
}
|
||||
|
||||
|
||||
|
||||
#if FF_MULTI_PARTITION
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Create Partition Table on the Physical Drive */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_fdisk (
|
||||
BYTE pdrv, /* Physical drive number */
|
||||
const DWORD* szt, /* Pointer to the size table for each partitions */
|
||||
void* work /* Pointer to the working buffer */
|
||||
)
|
||||
{
|
||||
UINT i, n, sz_cyl, tot_cyl, b_cyl, e_cyl, p_cyl;
|
||||
BYTE s_hd, e_hd, *p, *buf = (BYTE*)work;
|
||||
DSTATUS stat;
|
||||
DWORD sz_disk, sz_part, s_part;
|
||||
|
||||
|
||||
stat = disk_initialize(pdrv);
|
||||
if (stat & STA_NOINIT) return FR_NOT_READY;
|
||||
if (stat & STA_PROTECT) return FR_WRITE_PROTECTED;
|
||||
if (disk_ioctl(pdrv, GET_SECTOR_COUNT, &sz_disk)) return FR_DISK_ERR;
|
||||
|
||||
/* Determine the CHS without any consideration of the drive geometry */
|
||||
for (n = 16; n < 256 && sz_disk / n / 63 > 1024; n *= 2) ;
|
||||
if (n == 256) n--;
|
||||
e_hd = n - 1;
|
||||
sz_cyl = 63 * n;
|
||||
tot_cyl = sz_disk / sz_cyl;
|
||||
|
||||
/* Create partition table */
|
||||
mem_set(buf, 0, FF_MAX_SS);
|
||||
p = buf + MBR_Table; b_cyl = 0;
|
||||
for (i = 0; i < 4; i++, p += SZ_PTE) {
|
||||
p_cyl = (szt[i] <= 100U) ? (DWORD)tot_cyl * szt[i] / 100 : szt[i] / sz_cyl; /* Number of cylinders */
|
||||
if (p_cyl == 0) continue;
|
||||
s_part = (DWORD)sz_cyl * b_cyl;
|
||||
sz_part = (DWORD)sz_cyl * p_cyl;
|
||||
if (i == 0) { /* Exclude first track of cylinder 0 */
|
||||
s_hd = 1;
|
||||
s_part += 63; sz_part -= 63;
|
||||
} else {
|
||||
s_hd = 0;
|
||||
}
|
||||
e_cyl = b_cyl + p_cyl - 1; /* End cylinder */
|
||||
if (e_cyl >= tot_cyl) return FR_INVALID_PARAMETER;
|
||||
|
||||
/* Set partition table */
|
||||
p[1] = s_hd; /* Start head */
|
||||
p[2] = (BYTE)((b_cyl >> 2) + 1); /* Start sector */
|
||||
p[3] = (BYTE)b_cyl; /* Start cylinder */
|
||||
p[4] = 0x07; /* System type (temporary setting) */
|
||||
p[5] = e_hd; /* End head */
|
||||
p[6] = (BYTE)((e_cyl >> 2) + 63); /* End sector */
|
||||
p[7] = (BYTE)e_cyl; /* End cylinder */
|
||||
st_dword(p + 8, s_part); /* Start sector in LBA */
|
||||
st_dword(p + 12, sz_part); /* Number of sectors */
|
||||
|
||||
/* Next partition */
|
||||
b_cyl += p_cyl;
|
||||
}
|
||||
st_word(p, 0xAA55);
|
||||
|
||||
/* Write it to the MBR */
|
||||
return (disk_write(pdrv, buf, 0, 1) != RES_OK || disk_ioctl(pdrv, CTRL_SYNC, 0) != RES_OK) ? FR_DISK_ERR : FR_OK;
|
||||
}
|
||||
|
||||
#endif /* FF_MULTI_PARTITION */
|
||||
#endif /* FF_USE_MKFS && !FF_FS_READONLY */
|
||||
|
||||
|
||||
|
||||
|
||||
#if FF_USE_STRFUNC
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get a String from the File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
TCHAR* f_gets (
|
||||
TCHAR* buff, /* Pointer to the string buffer to read */
|
||||
int len, /* Size of string buffer (characters) */
|
||||
FIL* fp /* Pointer to the file object */
|
||||
)
|
||||
{
|
||||
int n = 0;
|
||||
TCHAR c, *p = buff;
|
||||
BYTE s[2];
|
||||
UINT rc;
|
||||
|
||||
|
||||
while (n < len - 1) { /* Read characters until buffer gets filled */
|
||||
#if FF_LFN_UNICODE && FF_USE_LFN /* Unicode API */
|
||||
#if FF_STRF_ENCODE == 3 /* Read a character in UTF-8 */
|
||||
f_read(fp, s, 1, &rc);
|
||||
if (rc != 1) break;
|
||||
c = s[0];
|
||||
if (c >= 0x80) {
|
||||
if (c < 0xC0) continue; /* Skip stray trailer */
|
||||
if (c < 0xE0) { /* Two-byte sequence (0x80-0x7FF) */
|
||||
f_read(fp, s, 1, &rc);
|
||||
if (rc != 1) break;
|
||||
c = (c & 0x1F) << 6 | (s[0] & 0x3F);
|
||||
if (c < 0x80) c = '?'; /* Reject invalid code range */
|
||||
} else {
|
||||
if (c < 0xF0) { /* Three-byte sequence (0x800-0xFFFF) */
|
||||
f_read(fp, s, 2, &rc);
|
||||
if (rc != 2) break;
|
||||
c = c << 12 | (s[0] & 0x3F) << 6 | (s[1] & 0x3F);
|
||||
if (c < 0x800) c = '?'; /* Reject invalid code range */
|
||||
} else { /* Reject four-byte sequence */
|
||||
c = '?';
|
||||
}
|
||||
}
|
||||
}
|
||||
#elif FF_STRF_ENCODE == 2 /* Read a character in UTF-16BE */
|
||||
f_read(fp, s, 2, &rc);
|
||||
if (rc != 2) break;
|
||||
c = s[1] + (s[0] << 8);
|
||||
#elif FF_STRF_ENCODE == 1 /* Read a character in UTF-16LE */
|
||||
f_read(fp, s, 2, &rc);
|
||||
if (rc != 2) break;
|
||||
c = s[0] + (s[1] << 8);
|
||||
#else /* Read a character in ANSI/OEM */
|
||||
f_read(fp, s, 1, &rc);
|
||||
if (rc != 1) break;
|
||||
c = s[0];
|
||||
if (dbc_1st((BYTE)c)) {
|
||||
f_read(fp, s, 1, &rc);
|
||||
if (rc != 1) break;
|
||||
c = (c << 8) + s[0];
|
||||
}
|
||||
c = ff_oem2uni(c, CODEPAGE); /* OEM -> Unicode */
|
||||
if (!c) c = '?';
|
||||
#endif
|
||||
#else /* ANSI/OEM API: Read a character without conversion */
|
||||
f_read(fp, s, 1, &rc);
|
||||
if (rc != 1) break;
|
||||
c = s[0];
|
||||
#endif
|
||||
if (FF_USE_STRFUNC == 2 && c == '\r') continue; /* Strip '\r' */
|
||||
*p++ = c;
|
||||
n++;
|
||||
if (c == '\n') break; /* Break on EOL */
|
||||
}
|
||||
*p = 0;
|
||||
return n ? buff : 0; /* When no data read (eof or error), return with error. */
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
#if !FF_FS_READONLY
|
||||
#include <stdarg.h>
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Put a Character to the File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
typedef struct {
|
||||
FIL *fp; /* Ptr to the writing file */
|
||||
int idx, nchr; /* Write index of buf[] (-1:error), number of chars written */
|
||||
BYTE buf[64]; /* Write buffer */
|
||||
} putbuff;
|
||||
|
||||
|
||||
static
|
||||
void putc_bfd ( /* Buffered write with code conversion */
|
||||
putbuff* pb,
|
||||
TCHAR c
|
||||
)
|
||||
{
|
||||
UINT bw;
|
||||
int i;
|
||||
|
||||
|
||||
if (FF_USE_STRFUNC == 2 && c == '\n') { /* LF -> CRLF conversion */
|
||||
putc_bfd(pb, '\r');
|
||||
}
|
||||
|
||||
i = pb->idx; /* Write index of pb->buf[] */
|
||||
if (i < 0) return;
|
||||
|
||||
#if FF_LFN_UNICODE && FF_USE_LFN /* Unicode API */
|
||||
#if FF_STRF_ENCODE == 3 /* Write a character in UTF-8 */
|
||||
if (c < 0x80) { /* 7-bit */
|
||||
pb->buf[i++] = (BYTE)c;
|
||||
} else {
|
||||
if (c < 0x800) { /* 11-bit */
|
||||
pb->buf[i++] = (BYTE)(0xC0 | c >> 6);
|
||||
} else { /* 16-bit */
|
||||
pb->buf[i++] = (BYTE)(0xE0 | c >> 12);
|
||||
pb->buf[i++] = (BYTE)(0x80 | (c >> 6 & 0x3F));
|
||||
}
|
||||
pb->buf[i++] = (BYTE)(0x80 | (c & 0x3F));
|
||||
}
|
||||
#elif FF_STRF_ENCODE == 2 /* Write a character in UTF-16BE */
|
||||
pb->buf[i++] = (BYTE)(c >> 8);
|
||||
pb->buf[i++] = (BYTE)c;
|
||||
#elif FF_STRF_ENCODE == 1 /* Write a character in UTF-16LE */
|
||||
pb->buf[i++] = (BYTE)c;
|
||||
pb->buf[i++] = (BYTE)(c >> 8);
|
||||
#else /* Write a character in ANSI/OEM */
|
||||
c = ff_uni2oem(c, CODEPAGE); /* Unicode -> OEM */
|
||||
if (!c) c = '?';
|
||||
if (c >= 0x100)
|
||||
pb->buf[i++] = (BYTE)(c >> 8);
|
||||
pb->buf[i++] = (BYTE)c;
|
||||
#endif
|
||||
#else /* ANSI/OEM API: Write a character without conversion */
|
||||
pb->buf[i++] = (BYTE)c;
|
||||
#endif
|
||||
|
||||
if (i >= (int)(sizeof pb->buf) - 3) { /* Write buffered characters to the file */
|
||||
f_write(pb->fp, pb->buf, (UINT)i, &bw);
|
||||
i = (bw == (UINT)i) ? 0 : -1;
|
||||
}
|
||||
pb->idx = i;
|
||||
pb->nchr++;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
int putc_flush ( /* Flush left characters in the buffer */
|
||||
putbuff* pb
|
||||
)
|
||||
{
|
||||
UINT nw;
|
||||
|
||||
if ( pb->idx >= 0 /* Flush buffered characters to the file */
|
||||
&& f_write(pb->fp, pb->buf, (UINT)pb->idx, &nw) == FR_OK
|
||||
&& (UINT)pb->idx == nw) return pb->nchr;
|
||||
return EOF;
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void putc_init ( /* Initialize write buffer */
|
||||
putbuff* pb,
|
||||
FIL* fp
|
||||
)
|
||||
{
|
||||
pb->fp = fp;
|
||||
pb->nchr = pb->idx = 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
int f_putc (
|
||||
TCHAR c, /* A character to be output */
|
||||
FIL* fp /* Pointer to the file object */
|
||||
)
|
||||
{
|
||||
putbuff pb;
|
||||
|
||||
|
||||
putc_init(&pb, fp);
|
||||
putc_bfd(&pb, c); /* Put the character */
|
||||
return putc_flush(&pb);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Put a String to the File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
int f_puts (
|
||||
const TCHAR* str, /* Pointer to the string to be output */
|
||||
FIL* fp /* Pointer to the file object */
|
||||
)
|
||||
{
|
||||
putbuff pb;
|
||||
|
||||
|
||||
putc_init(&pb, fp);
|
||||
while (*str) putc_bfd(&pb, *str++); /* Put the string */
|
||||
return putc_flush(&pb);
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Put a Formatted String to the File */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
int f_printf (
|
||||
FIL* fp, /* Pointer to the file object */
|
||||
const TCHAR* fmt, /* Pointer to the format string */
|
||||
... /* Optional arguments... */
|
||||
)
|
||||
{
|
||||
va_list arp;
|
||||
putbuff pb;
|
||||
BYTE f, r;
|
||||
UINT i, j, w;
|
||||
DWORD v;
|
||||
TCHAR c, d, str[32], *p;
|
||||
|
||||
|
||||
putc_init(&pb, fp);
|
||||
|
||||
va_start(arp, fmt);
|
||||
|
||||
for (;;) {
|
||||
c = *fmt++;
|
||||
if (c == 0) break; /* End of string */
|
||||
if (c != '%') { /* Non escape character */
|
||||
putc_bfd(&pb, c);
|
||||
continue;
|
||||
}
|
||||
w = f = 0;
|
||||
c = *fmt++;
|
||||
if (c == '0') { /* Flag: '0' padding */
|
||||
f = 1; c = *fmt++;
|
||||
} else {
|
||||
if (c == '-') { /* Flag: left justified */
|
||||
f = 2; c = *fmt++;
|
||||
}
|
||||
}
|
||||
while (IsDigit(c)) { /* Precision */
|
||||
w = w * 10 + c - '0';
|
||||
c = *fmt++;
|
||||
}
|
||||
if (c == 'l' || c == 'L') { /* Prefix: Size is long int */
|
||||
f |= 4; c = *fmt++;
|
||||
}
|
||||
if (!c) break;
|
||||
d = c;
|
||||
if (IsLower(d)) d -= 0x20;
|
||||
switch (d) { /* Type is... */
|
||||
case 'S' : /* String */
|
||||
p = va_arg(arp, TCHAR*);
|
||||
for (j = 0; p[j]; j++) ;
|
||||
if (!(f & 2)) { /* Right pad */
|
||||
while (j++ < w) putc_bfd(&pb, ' ');
|
||||
}
|
||||
while (*p) putc_bfd(&pb, *p++); /* String body */
|
||||
while (j++ < w) putc_bfd(&pb, ' '); /* Left pad */
|
||||
continue;
|
||||
|
||||
case 'C' : /* Character */
|
||||
putc_bfd(&pb, (TCHAR)va_arg(arp, int)); continue;
|
||||
|
||||
case 'B' : /* Binary */
|
||||
r = 2; break;
|
||||
|
||||
case 'O' : /* Octal */
|
||||
r = 8; break;
|
||||
|
||||
case 'D' : /* Signed decimal */
|
||||
case 'U' : /* Unsigned decimal */
|
||||
r = 10; break;
|
||||
|
||||
case 'X' : /* Hexdecimal */
|
||||
r = 16; break;
|
||||
|
||||
default: /* Unknown type (pass-through) */
|
||||
putc_bfd(&pb, c); continue;
|
||||
}
|
||||
|
||||
/* Get an argument and put it in numeral */
|
||||
v = (f & 4) ? (DWORD)va_arg(arp, long) : ((d == 'D') ? (DWORD)(long)va_arg(arp, int) : (DWORD)va_arg(arp, unsigned int));
|
||||
if (d == 'D' && (v & 0x80000000)) {
|
||||
v = 0 - v;
|
||||
f |= 8;
|
||||
}
|
||||
i = 0;
|
||||
do {
|
||||
d = (TCHAR)(v % r); v /= r;
|
||||
if (d > 9) d += (c == 'x') ? 0x27 : 0x07;
|
||||
str[i++] = d + '0';
|
||||
} while (v && i < sizeof str / sizeof *str);
|
||||
if (f & 8) str[i++] = '-';
|
||||
j = i; d = (f & 1) ? '0' : ' ';
|
||||
if (!(f & 2)) {
|
||||
while (j++ < w) putc_bfd(&pb, d); /* Right pad */
|
||||
}
|
||||
do {
|
||||
putc_bfd(&pb, str[--i]); /* Number body */
|
||||
} while (i);
|
||||
while (j++ < w) putc_bfd(&pb, d); /* Left pad */
|
||||
}
|
||||
|
||||
va_end(arp);
|
||||
|
||||
return putc_flush(&pb);
|
||||
}
|
||||
|
||||
#endif /* !FF_FS_READONLY */
|
||||
#endif /* FF_USE_STRFUNC */
|
||||
|
||||
|
||||
|
||||
#if FF_CODE_PAGE == 0
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Set Active Codepage for the Path Name */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
FRESULT f_setcp (
|
||||
WORD cp /* Value to be set as active code page */
|
||||
)
|
||||
{
|
||||
static const WORD validcp[] = { 437, 720, 737, 771, 775, 850, 852, 857, 860, 861, 862, 863, 864, 865, 866, 869, 932, 936, 949, 950, 0};
|
||||
static const BYTE *const tables[] = {Ct437, Ct720, Ct737, Ct771, Ct775, Ct850, Ct852, Ct857, Ct860, Ct861, Ct862, Ct863, Ct864, Ct865, Ct866, Ct869, Dc932, Dc936, Dc949, Dc950, 0};
|
||||
UINT i;
|
||||
|
||||
|
||||
for (i = 0; validcp[i] != 0 && validcp[i] != cp; i++) ; /* Find the code page */
|
||||
if (validcp[i] != cp) return FR_INVALID_PARAMETER;
|
||||
|
||||
CodePage = cp;
|
||||
if (cp >= 900) { /* DBCS */
|
||||
ExCvt = 0;
|
||||
DbcTbl = tables[i];
|
||||
} else { /* SBCS */
|
||||
ExCvt = tables[i];
|
||||
DbcTbl = 0;
|
||||
}
|
||||
return FR_OK;
|
||||
}
|
||||
#endif /* FF_CODE_PAGE == 0 */
|
||||
|
||||
|
|
@ -1,364 +0,0 @@
|
|||
/*----------------------------------------------------------------------------/
|
||||
/ FatFs - Generic FAT Filesystem module R0.13 /
|
||||
/-----------------------------------------------------------------------------/
|
||||
/
|
||||
/ Copyright (C) 2017, ChaN, all right reserved.
|
||||
/
|
||||
/ FatFs module is an open source software. Redistribution and use of FatFs in
|
||||
/ source and binary forms, with or without modification, are permitted provided
|
||||
/ that the following condition is met:
|
||||
|
||||
/ 1. Redistributions of source code must retain the above copyright notice,
|
||||
/ this condition and the following disclaimer.
|
||||
/
|
||||
/ This software is provided by the copyright holder and contributors "AS IS"
|
||||
/ and any warranties related to this software are DISCLAIMED.
|
||||
/ The copyright owner or contributors be NOT LIABLE for any damages caused
|
||||
/ by use of this software.
|
||||
/
|
||||
/----------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
#ifndef FF_DEFINED
|
||||
#define FF_DEFINED 87030 /* Revision ID */
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
#include "integer.h" /* Basic integer types */
|
||||
#include "ffconf.h" /* FatFs configuration options */
|
||||
|
||||
#if FF_DEFINED != FFCONF_DEF
|
||||
#error Wrong configuration file (ffconf.h).
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
/* Definitions of volume management */
|
||||
|
||||
#if FF_MULTI_PARTITION /* Multiple partition configuration */
|
||||
typedef struct {
|
||||
BYTE pd; /* Physical drive number */
|
||||
BYTE pt; /* Partition: 0:Auto detect, 1-4:Forced partition) */
|
||||
} PARTITION;
|
||||
extern PARTITION VolToPart[]; /* Volume - Partition resolution table */
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
/* Type of path name strings on FatFs API */
|
||||
|
||||
#if FF_LFN_UNICODE && FF_USE_LFN /* Unicode (UTF-16) string */
|
||||
#ifndef _INC_TCHAR
|
||||
typedef WCHAR TCHAR;
|
||||
#define _T(x) L ## x
|
||||
#define _TEXT(x) L ## x
|
||||
#define _INC_TCHAR
|
||||
#endif
|
||||
#else /* ANSI/OEM string */
|
||||
#ifndef _INC_TCHAR
|
||||
typedef char TCHAR;
|
||||
#define _T(x) x
|
||||
#define _TEXT(x) x
|
||||
#define _INC_TCHAR
|
||||
#endif
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
/* Type of file size variables */
|
||||
|
||||
#if FF_FS_EXFAT
|
||||
#if !FF_USE_LFN
|
||||
#error LFN must be enabled when enable exFAT
|
||||
#endif
|
||||
typedef QWORD FSIZE_t;
|
||||
#else
|
||||
typedef DWORD FSIZE_t;
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
/* Filesystem object structure (FATFS) */
|
||||
|
||||
typedef struct {
|
||||
BYTE fs_type; /* Filesystem type (0:N/A) */
|
||||
BYTE pdrv; /* Physical drive number */
|
||||
BYTE n_fats; /* Number of FATs (1 or 2) */
|
||||
BYTE wflag; /* win[] flag (b0:dirty) */
|
||||
BYTE fsi_flag; /* FSINFO flags (b7:disabled, b0:dirty) */
|
||||
WORD id; /* Volume mount ID */
|
||||
WORD n_rootdir; /* Number of root directory entries (FAT12/16) */
|
||||
WORD csize; /* Cluster size [sectors] */
|
||||
#if FF_MAX_SS != FF_MIN_SS
|
||||
WORD ssize; /* Sector size (512, 1024, 2048 or 4096) */
|
||||
#endif
|
||||
#if FF_USE_LFN
|
||||
WCHAR* lfnbuf; /* LFN working buffer */
|
||||
#endif
|
||||
#if FF_FS_EXFAT
|
||||
BYTE* dirbuf; /* Directory entry block scratchpad buffer for exFAT */
|
||||
#endif
|
||||
#if FF_FS_REENTRANT
|
||||
FF_SYNC_t sobj; /* Identifier of sync object */
|
||||
#endif
|
||||
#if !FF_FS_READONLY
|
||||
DWORD last_clst; /* Last allocated cluster */
|
||||
DWORD free_clst; /* Number of free clusters */
|
||||
#endif
|
||||
#if FF_FS_RPATH
|
||||
DWORD cdir; /* Current directory start cluster (0:root) */
|
||||
#if FF_FS_EXFAT
|
||||
DWORD cdc_scl; /* Containing directory start cluster (invalid when cdir is 0) */
|
||||
DWORD cdc_size; /* b31-b8:Size of containing directory, b7-b0: Chain status */
|
||||
DWORD cdc_ofs; /* Offset in the containing directory (invalid when cdir is 0) */
|
||||
#endif
|
||||
#endif
|
||||
DWORD n_fatent; /* Number of FAT entries (number of clusters + 2) */
|
||||
DWORD fsize; /* Size of an FAT [sectors] */
|
||||
DWORD volbase; /* Volume base sector */
|
||||
DWORD fatbase; /* FAT base sector */
|
||||
DWORD dirbase; /* Root directory base sector/cluster */
|
||||
DWORD database; /* Data base sector */
|
||||
DWORD winsect; /* Current sector appearing in the win[] */
|
||||
BYTE win[FF_MAX_SS]; /* Disk access window for Directory, FAT (and file data at tiny cfg) */
|
||||
} FATFS;
|
||||
|
||||
|
||||
|
||||
/* Object ID and allocation information (FFOBJID) */
|
||||
|
||||
typedef struct {
|
||||
FATFS* fs; /* Pointer to the hosting volume of this object */
|
||||
WORD id; /* Hosting volume mount ID */
|
||||
BYTE attr; /* Object attribute */
|
||||
BYTE stat; /* Object chain status (b1-0: =0:not contiguous, =2:contiguous, =3:flagmented in this session, b2:sub-directory stretched) */
|
||||
DWORD sclust; /* Object data start cluster (0:no cluster or root directory) */
|
||||
FSIZE_t objsize; /* Object size (valid when sclust != 0) */
|
||||
#if FF_FS_EXFAT
|
||||
DWORD n_cont; /* Size of first fragment - 1 (valid when stat == 3) */
|
||||
DWORD n_frag; /* Size of last fragment needs to be written to FAT (valid when not zero) */
|
||||
DWORD c_scl; /* Containing directory start cluster (valid when sclust != 0) */
|
||||
DWORD c_size; /* b31-b8:Size of containing directory, b7-b0: Chain status (valid when c_scl != 0) */
|
||||
DWORD c_ofs; /* Offset in the containing directory (valid when file object and sclust != 0) */
|
||||
#endif
|
||||
#if FF_FS_LOCK
|
||||
UINT lockid; /* File lock ID origin from 1 (index of file semaphore table Files[]) */
|
||||
#endif
|
||||
} FFOBJID;
|
||||
|
||||
|
||||
|
||||
/* File object structure (FIL) */
|
||||
|
||||
typedef struct {
|
||||
FFOBJID obj; /* Object identifier (must be the 1st member to detect invalid object pointer) */
|
||||
BYTE flag; /* File status flags */
|
||||
BYTE err; /* Abort flag (error code) */
|
||||
FSIZE_t fptr; /* File read/write pointer (Zeroed on file open) */
|
||||
DWORD clust; /* Current cluster of fpter (invalid when fptr is 0) */
|
||||
DWORD sect; /* Sector number appearing in buf[] (0:invalid) */
|
||||
#if !FF_FS_READONLY
|
||||
DWORD dir_sect; /* Sector number containing the directory entry (not used at exFAT) */
|
||||
BYTE* dir_ptr; /* Pointer to the directory entry in the win[] (not used at exFAT) */
|
||||
#endif
|
||||
#if FF_USE_FASTSEEK
|
||||
DWORD* cltbl; /* Pointer to the cluster link map table (nulled on open, set by application) */
|
||||
#endif
|
||||
#if !FF_FS_TINY
|
||||
BYTE buf[FF_MAX_SS]; /* File private data read/write window */
|
||||
#endif
|
||||
} FIL;
|
||||
|
||||
|
||||
|
||||
/* Directory object structure (DIR) */
|
||||
|
||||
typedef struct {
|
||||
FFOBJID obj; /* Object identifier */
|
||||
DWORD dptr; /* Current read/write offset */
|
||||
DWORD clust; /* Current cluster */
|
||||
DWORD sect; /* Current sector (0:Read operation has terminated) */
|
||||
BYTE* dir; /* Pointer to the directory item in the win[] */
|
||||
BYTE fn[12]; /* SFN (in/out) {body[8],ext[3],status[1]} */
|
||||
#if FF_USE_LFN
|
||||
DWORD blk_ofs; /* Offset of current entry block being processed (0xFFFFFFFF:Invalid) */
|
||||
#endif
|
||||
#if FF_USE_FIND
|
||||
const TCHAR* pat; /* Pointer to the name matching pattern */
|
||||
#endif
|
||||
} DIR;
|
||||
|
||||
|
||||
|
||||
/* File information structure (FILINFO) */
|
||||
|
||||
typedef struct {
|
||||
FSIZE_t fsize; /* File size */
|
||||
WORD fdate; /* Modified date */
|
||||
WORD ftime; /* Modified time */
|
||||
BYTE fattrib; /* File attribute */
|
||||
#if FF_USE_LFN
|
||||
TCHAR altname[13]; /* Altenative file name */
|
||||
TCHAR fname[FF_MAX_LFN + 1]; /* Primary file name */
|
||||
#else
|
||||
TCHAR fname[13]; /* File name */
|
||||
#endif
|
||||
} FILINFO;
|
||||
|
||||
|
||||
|
||||
/* File function return code (FRESULT) */
|
||||
|
||||
typedef enum {
|
||||
FR_OK = 0, /* (0) Succeeded */
|
||||
FR_DISK_ERR, /* (1) A hard error occurred in the low level disk I/O layer */
|
||||
FR_INT_ERR, /* (2) Assertion failed */
|
||||
FR_NOT_READY, /* (3) The physical drive cannot work */
|
||||
FR_NO_FILE, /* (4) Could not find the file */
|
||||
FR_NO_PATH, /* (5) Could not find the path */
|
||||
FR_INVALID_NAME, /* (6) The path name format is invalid */
|
||||
FR_DENIED, /* (7) Access denied due to prohibited access or directory full */
|
||||
FR_EXIST, /* (8) Access denied due to prohibited access */
|
||||
FR_INVALID_OBJECT, /* (9) The file/directory object is invalid */
|
||||
FR_WRITE_PROTECTED, /* (10) The physical drive is write protected */
|
||||
FR_INVALID_DRIVE, /* (11) The logical drive number is invalid */
|
||||
FR_NOT_ENABLED, /* (12) The volume has no work area */
|
||||
FR_NO_FILESYSTEM, /* (13) There is no valid FAT volume */
|
||||
FR_MKFS_ABORTED, /* (14) The f_mkfs() aborted due to any problem */
|
||||
FR_TIMEOUT, /* (15) Could not get a grant to access the volume within defined period */
|
||||
FR_LOCKED, /* (16) The operation is rejected according to the file sharing policy */
|
||||
FR_NOT_ENOUGH_CORE, /* (17) LFN working buffer could not be allocated */
|
||||
FR_TOO_MANY_OPEN_FILES, /* (18) Number of open files > FF_FS_LOCK */
|
||||
FR_INVALID_PARAMETER /* (19) Given parameter is invalid */
|
||||
} FRESULT;
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------*/
|
||||
/* FatFs module application interface */
|
||||
|
||||
FRESULT f_open (FIL* fp, const TCHAR* path, BYTE mode); /* Open or create a file */
|
||||
FRESULT f_close (FIL* fp); /* Close an open file object */
|
||||
FRESULT f_read (FIL* fp, void* buff, UINT btr, UINT* br); /* Read data from the file */
|
||||
FRESULT f_write (FIL* fp, const void* buff, UINT btw, UINT* bw); /* Write data to the file */
|
||||
FRESULT f_lseek (FIL* fp, FSIZE_t ofs); /* Move file pointer of the file object */
|
||||
FRESULT f_truncate (FIL* fp); /* Truncate the file */
|
||||
FRESULT f_sync (FIL* fp); /* Flush cached data of the writing file */
|
||||
FRESULT f_opendir (DIR* dp, const TCHAR* path); /* Open a directory */
|
||||
FRESULT f_closedir (DIR* dp); /* Close an open directory */
|
||||
FRESULT f_readdir (DIR* dp, FILINFO* fno); /* Read a directory item */
|
||||
FRESULT f_findfirst (DIR* dp, FILINFO* fno, const TCHAR* path, const TCHAR* pattern); /* Find first file */
|
||||
FRESULT f_findnext (DIR* dp, FILINFO* fno); /* Find next file */
|
||||
FRESULT f_mkdir (const TCHAR* path); /* Create a sub directory */
|
||||
FRESULT f_unlink (const TCHAR* path); /* Delete an existing file or directory */
|
||||
FRESULT f_rename (const TCHAR* path_old, const TCHAR* path_new); /* Rename/Move a file or directory */
|
||||
FRESULT f_stat (const TCHAR* path, FILINFO* fno); /* Get file status */
|
||||
FRESULT f_chmod (const TCHAR* path, BYTE attr, BYTE mask); /* Change attribute of a file/dir */
|
||||
FRESULT f_utime (const TCHAR* path, const FILINFO* fno); /* Change timestamp of a file/dir */
|
||||
FRESULT f_chdir (const TCHAR* path); /* Change current directory */
|
||||
FRESULT f_chdrive (const TCHAR* path); /* Change current drive */
|
||||
FRESULT f_getcwd (TCHAR* buff, UINT len); /* Get current directory */
|
||||
FRESULT f_getfree (const TCHAR* path, DWORD* nclst, FATFS** fatfs); /* Get number of free clusters on the drive */
|
||||
FRESULT f_getlabel (const TCHAR* path, TCHAR* label, DWORD* vsn); /* Get volume label */
|
||||
FRESULT f_setlabel (const TCHAR* label); /* Set volume label */
|
||||
FRESULT f_forward (FIL* fp, UINT(*func)(const BYTE*,UINT), UINT btf, UINT* bf); /* Forward data to the stream */
|
||||
FRESULT f_expand (FIL* fp, FSIZE_t szf, BYTE opt); /* Allocate a contiguous block to the file */
|
||||
FRESULT f_mount (FATFS* fs, const TCHAR* path, BYTE opt); /* Mount/Unmount a logical drive */
|
||||
FRESULT f_mkfs (const TCHAR* path, BYTE opt, DWORD au, void* work, UINT len); /* Create a FAT volume */
|
||||
FRESULT f_fdisk (BYTE pdrv, const DWORD* szt, void* work); /* Divide a physical drive into some partitions */
|
||||
FRESULT f_setcp (WORD cp); /* Set current code page */
|
||||
int f_putc (TCHAR c, FIL* fp); /* Put a character to the file */
|
||||
int f_puts (const TCHAR* str, FIL* cp); /* Put a string to the file */
|
||||
int f_printf (FIL* fp, const TCHAR* str, ...); /* Put a formatted string to the file */
|
||||
TCHAR* f_gets (TCHAR* buff, int len, FIL* fp); /* Get a string from the file */
|
||||
|
||||
#define f_eof(fp) ((int)((fp)->fptr == (fp)->obj.objsize))
|
||||
#define f_error(fp) ((fp)->err)
|
||||
#define f_tell(fp) ((fp)->fptr)
|
||||
#define f_size(fp) ((fp)->obj.objsize)
|
||||
#define f_rewind(fp) f_lseek((fp), 0)
|
||||
#define f_rewinddir(dp) f_readdir((dp), 0)
|
||||
#define f_rmdir(path) f_unlink(path)
|
||||
#define f_unmount(path) f_mount(0, path, 0)
|
||||
|
||||
#ifndef EOF
|
||||
#define EOF (-1)
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------*/
|
||||
/* Additional user defined functions */
|
||||
|
||||
/* RTC function */
|
||||
#if !FF_FS_READONLY && !FF_FS_NORTC
|
||||
DWORD get_fattime (void);
|
||||
#endif
|
||||
|
||||
/* LFN support functions */
|
||||
#if FF_USE_LFN /* Code conversion (defined in unicode.c) */
|
||||
WCHAR ff_oem2uni (WCHAR oem, WORD cp); /* OEM code to Unicode conversion */
|
||||
WCHAR ff_uni2oem (WCHAR uni, WORD cp); /* Unicode to OEM code conversion */
|
||||
WCHAR ff_wtoupper (WCHAR uni); /* Unicode upper-case conversion */
|
||||
#endif
|
||||
#if FF_USE_LFN == 3 /* Dynamic memory allocation */
|
||||
void* ff_memalloc (UINT msize); /* Allocate memory block */
|
||||
void ff_memfree (void* mblock); /* Free memory block */
|
||||
#endif
|
||||
|
||||
/* Sync functions */
|
||||
#if FF_FS_REENTRANT
|
||||
int ff_cre_syncobj (BYTE vol, FF_SYNC_t* sobj); /* Create a sync object */
|
||||
int ff_req_grant (FF_SYNC_t sobj); /* Lock sync object */
|
||||
void ff_rel_grant (FF_SYNC_t sobj); /* Unlock sync object */
|
||||
int ff_del_syncobj (FF_SYNC_t sobj); /* Delete a sync object */
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------*/
|
||||
/* Flags and offset address */
|
||||
|
||||
|
||||
/* File access mode and open method flags (3rd argument of f_open) */
|
||||
#define FA_READ 0x01
|
||||
#define FA_WRITE 0x02
|
||||
#define FA_OPEN_EXISTING 0x00
|
||||
#define FA_CREATE_NEW 0x04
|
||||
#define FA_CREATE_ALWAYS 0x08
|
||||
#define FA_OPEN_ALWAYS 0x10
|
||||
#define FA_OPEN_APPEND 0x30
|
||||
|
||||
/* Fast seek controls (2nd argument of f_lseek) */
|
||||
#define CREATE_LINKMAP ((FSIZE_t)0 - 1)
|
||||
|
||||
/* Format options (2nd argument of f_mkfs) */
|
||||
#define FM_FAT 0x01
|
||||
#define FM_FAT32 0x02
|
||||
#define FM_EXFAT 0x04
|
||||
#define FM_ANY 0x07
|
||||
#define FM_SFD 0x08
|
||||
|
||||
/* Filesystem type (FATFS.fs_type) */
|
||||
#define FS_FAT12 1
|
||||
#define FS_FAT16 2
|
||||
#define FS_FAT32 3
|
||||
#define FS_EXFAT 4
|
||||
|
||||
/* File attribute bits for directory entry (FILINFO.fattrib) */
|
||||
#define AM_RDO 0x01 /* Read only */
|
||||
#define AM_HID 0x02 /* Hidden */
|
||||
#define AM_SYS 0x04 /* System */
|
||||
#define AM_DIR 0x10 /* Directory */
|
||||
#define AM_ARC 0x20 /* Archive */
|
||||
|
||||
|
||||
#ifdef __cplusplus
|
||||
}
|
||||
#endif
|
||||
|
||||
#endif /* FF_DEFINED */
|
|
@ -1,269 +0,0 @@
|
|||
/*---------------------------------------------------------------------------/
|
||||
/ FatFs - Configuration file
|
||||
/---------------------------------------------------------------------------*/
|
||||
|
||||
#define FFCONF_DEF 87030 /* Revision ID */
|
||||
|
||||
/*---------------------------------------------------------------------------/
|
||||
/ Function Configurations
|
||||
/---------------------------------------------------------------------------*/
|
||||
|
||||
#define FF_FS_READONLY 0
|
||||
/* This option switches read-only configuration. (0:Read/Write or 1:Read-only)
|
||||
/ Read-only configuration removes writing API functions, f_write(), f_sync(),
|
||||
/ f_unlink(), f_mkdir(), f_chmod(), f_rename(), f_truncate(), f_getfree()
|
||||
/ and optional writing functions as well. */
|
||||
|
||||
|
||||
#define FF_FS_MINIMIZE 0
|
||||
/* This option defines minimization level to remove some basic API functions.
|
||||
/
|
||||
/ 0: All basic functions are enabled.
|
||||
/ 1: f_stat(), f_getfree(), f_unlink(), f_mkdir(), f_truncate() and f_rename()
|
||||
/ are removed.
|
||||
/ 2: f_opendir(), f_readdir() and f_closedir() are removed in addition to 1.
|
||||
/ 3: f_lseek() function is removed in addition to 2. */
|
||||
|
||||
|
||||
#define FF_USE_STRFUNC 0
|
||||
/* This option switches string functions, f_gets(), f_putc(), f_puts() and f_printf().
|
||||
/
|
||||
/ 0: Disable string functions.
|
||||
/ 1: Enable without LF-CRLF conversion.
|
||||
/ 2: Enable with LF-CRLF conversion. */
|
||||
|
||||
|
||||
#define FF_USE_FIND 1
|
||||
/* This option switches filtered directory read functions, f_findfirst() and
|
||||
/ f_findnext(). (0:Disable, 1:Enable 2:Enable with matching altname[] too) */
|
||||
|
||||
|
||||
#define FF_USE_MKFS 1
|
||||
/* This option switches f_mkfs() function. (0:Disable or 1:Enable) */
|
||||
|
||||
|
||||
#define FF_USE_FASTSEEK 0
|
||||
/* This option switches fast seek function. (0:Disable or 1:Enable) */
|
||||
|
||||
|
||||
#define FF_USE_EXPAND 0
|
||||
/* This option switches f_expand function. (0:Disable or 1:Enable) */
|
||||
|
||||
|
||||
#define FF_USE_CHMOD 1
|
||||
/* This option switches attribute manipulation functions, f_chmod() and f_utime().
|
||||
/ (0:Disable or 1:Enable) Also FF_FS_READONLY needs to be 0 to enable this option. */
|
||||
|
||||
|
||||
#define FF_USE_LABEL 1
|
||||
/* This option switches volume label functions, f_getlabel() and f_setlabel().
|
||||
/ (0:Disable or 1:Enable) */
|
||||
|
||||
|
||||
#define FF_USE_FORWARD 0
|
||||
/* This option switches f_forward() function. (0:Disable or 1:Enable) */
|
||||
|
||||
|
||||
/*---------------------------------------------------------------------------/
|
||||
/ Locale and Namespace Configurations
|
||||
/---------------------------------------------------------------------------*/
|
||||
|
||||
#define FF_CODE_PAGE 932
|
||||
/* This option specifies the OEM code page to be used on the target system.
|
||||
/ Incorrect code page setting can cause a file open failure.
|
||||
/
|
||||
/ 437 - U.S.
|
||||
/ 720 - Arabic
|
||||
/ 737 - Greek
|
||||
/ 771 - KBL
|
||||
/ 775 - Baltic
|
||||
/ 850 - Latin 1
|
||||
/ 852 - Latin 2
|
||||
/ 855 - Cyrillic
|
||||
/ 857 - Turkish
|
||||
/ 860 - Portuguese
|
||||
/ 861 - Icelandic
|
||||
/ 862 - Hebrew
|
||||
/ 863 - Canadian French
|
||||
/ 864 - Arabic
|
||||
/ 865 - Nordic
|
||||
/ 866 - Russian
|
||||
/ 869 - Greek 2
|
||||
/ 932 - Japanese (DBCS)
|
||||
/ 936 - Simplified Chinese (DBCS)
|
||||
/ 949 - Korean (DBCS)
|
||||
/ 950 - Traditional Chinese (DBCS)
|
||||
/ 0 - Include all code pages above and configured by f_setcp()
|
||||
*/
|
||||
|
||||
|
||||
#define FF_USE_LFN 1
|
||||
#define FF_MAX_LFN 255
|
||||
/* The FF_USE_LFN switches the support for LFN (long file name).
|
||||
/
|
||||
/ 0: Disable LFN. FF_MAX_LFN has no effect.
|
||||
/ 1: Enable LFN with static working buffer on the BSS. Always NOT thread-safe.
|
||||
/ 2: Enable LFN with dynamic working buffer on the STACK.
|
||||
/ 3: Enable LFN with dynamic working buffer on the HEAP.
|
||||
/
|
||||
/ To enable the LFN, Unicode handling functions (option/unicode.c) must be added
|
||||
/ to the project. The working buffer occupies (FF_MAX_LFN + 1) * 2 bytes and
|
||||
/ additional 608 bytes at exFAT enabled. FF_MAX_LFN can be in range from 12 to 255.
|
||||
/ It should be set 255 to support full featured LFN operations.
|
||||
/ When use stack for the working buffer, take care on stack overflow. When use heap
|
||||
/ memory for the working buffer, memory management functions, ff_memalloc() and
|
||||
/ ff_memfree(), must be added to the project. */
|
||||
|
||||
|
||||
#define FF_LFN_UNICODE 0
|
||||
/* This option switches character encoding on the API, 0:ANSI/OEM or 1:UTF-16,
|
||||
/ when LFN is enabled. Also behavior of string I/O functions will be affected by
|
||||
/ this option. When LFN is not enabled, this option has no effect.
|
||||
*/
|
||||
|
||||
|
||||
#define FF_STRF_ENCODE 3
|
||||
/* When FF_LFN_UNICODE = 1 with LFN enabled, string I/O functions, f_gets(),
|
||||
/ f_putc(), f_puts and f_printf() convert the character encoding in it.
|
||||
/ This option selects assumption of character encoding ON THE FILE to be
|
||||
/ read/written via those functions.
|
||||
/
|
||||
/ 0: ANSI/OEM
|
||||
/ 1: UTF-16LE
|
||||
/ 2: UTF-16BE
|
||||
/ 3: UTF-8
|
||||
*/
|
||||
|
||||
|
||||
#define FF_FS_RPATH 2
|
||||
/* This option configures support for relative path.
|
||||
/
|
||||
/ 0: Disable relative path and remove related functions.
|
||||
/ 1: Enable relative path. f_chdir() and f_chdrive() are available.
|
||||
/ 2: f_getcwd() function is available in addition to 1.
|
||||
*/
|
||||
|
||||
|
||||
/*---------------------------------------------------------------------------/
|
||||
/ Drive/Volume Configurations
|
||||
/---------------------------------------------------------------------------*/
|
||||
|
||||
#define FF_VOLUMES 1
|
||||
/* Number of volumes (logical drives) to be used. (1-10) */
|
||||
|
||||
|
||||
#define FF_STR_VOLUME_ID 0
|
||||
#define FF_VOLUME_STRS "RAM","NAND","CF","SD","SD2","USB","USB2","USB3"
|
||||
/* FF_STR_VOLUME_ID switches string support for volume ID.
|
||||
/ When FF_STR_VOLUME_ID is set to 1, also pre-defined strings can be used as drive
|
||||
/ number in the path name. FF_VOLUME_STRS defines the drive ID strings for each
|
||||
/ logical drives. Number of items must be equal to FF_VOLUMES. Valid characters for
|
||||
/ the drive ID strings are: A-Z and 0-9. */
|
||||
|
||||
|
||||
#define FF_MULTI_PARTITION 0
|
||||
/* This option switches support for multiple volumes on the physical drive.
|
||||
/ By default (0), each logical drive number is bound to the same physical drive
|
||||
/ number and only an FAT volume found on the physical drive will be mounted.
|
||||
/ When this function is enabled (1), each logical drive number can be bound to
|
||||
/ arbitrary physical drive and partition listed in the VolToPart[]. Also f_fdisk()
|
||||
/ funciton will be available. */
|
||||
|
||||
|
||||
#define FF_MIN_SS 512
|
||||
#define FF_MAX_SS 512
|
||||
/* This set of options configures the range of sector size to be supported. (512,
|
||||
/ 1024, 2048 or 4096) Always set both 512 for most systems, generic memory card and
|
||||
/ harddisk. But a larger value may be required for on-board flash memory and some
|
||||
/ type of optical media. When FF_MAX_SS is larger than FF_MIN_SS, FatFs is configured
|
||||
/ for variable sector size mode and disk_ioctl() function needs to implement
|
||||
/ GET_SECTOR_SIZE command. */
|
||||
|
||||
|
||||
#define FF_USE_TRIM 0
|
||||
/* This option switches support for ATA-TRIM. (0:Disable or 1:Enable)
|
||||
/ To enable Trim function, also CTRL_TRIM command should be implemented to the
|
||||
/ disk_ioctl() function. */
|
||||
|
||||
|
||||
#define FF_FS_NOFSINFO 0
|
||||
/* If you need to know correct free space on the FAT32 volume, set bit 0 of this
|
||||
/ option, and f_getfree() function at first time after volume mount will force
|
||||
/ a full FAT scan. Bit 1 controls the use of last allocated cluster number.
|
||||
/
|
||||
/ bit0=0: Use free cluster count in the FSINFO if available.
|
||||
/ bit0=1: Do not trust free cluster count in the FSINFO.
|
||||
/ bit1=0: Use last allocated cluster number in the FSINFO if available.
|
||||
/ bit1=1: Do not trust last allocated cluster number in the FSINFO.
|
||||
*/
|
||||
|
||||
|
||||
|
||||
/*---------------------------------------------------------------------------/
|
||||
/ System Configurations
|
||||
/---------------------------------------------------------------------------*/
|
||||
|
||||
#define FF_FS_TINY 0
|
||||
/* This option switches tiny buffer configuration. (0:Normal or 1:Tiny)
|
||||
/ At the tiny configuration, size of file object (FIL) is shrinked FF_MAX_SS bytes.
|
||||
/ Instead of private sector buffer eliminated from the file object, common sector
|
||||
/ buffer in the filesystem object (FATFS) is used for the file data transfer. */
|
||||
|
||||
|
||||
#define FF_FS_EXFAT 0
|
||||
/* This option switches support for exFAT filesystem. (0:Disable or 1:Enable)
|
||||
/ When enable exFAT, also LFN needs to be enabled.
|
||||
/ Note that enabling exFAT discards ANSI C (C89) compatibility. */
|
||||
|
||||
|
||||
#define FF_FS_NORTC 0
|
||||
#define FF_NORTC_MON 1
|
||||
#define FF_NORTC_MDAY 1
|
||||
#define FF_NORTC_YEAR 2016
|
||||
/* The option FF_FS_NORTC switches timestamp functiton. If the system does not have
|
||||
/ any RTC function or valid timestamp is not needed, set FF_FS_NORTC = 1 to disable
|
||||
/ the timestamp function. All objects modified by FatFs will have a fixed timestamp
|
||||
/ defined by FF_NORTC_MON, FF_NORTC_MDAY and FF_NORTC_YEAR in local time.
|
||||
/ To enable timestamp function (FF_FS_NORTC = 0), get_fattime() function need to be
|
||||
/ added to the project to read current time form real-time clock. FF_NORTC_MON,
|
||||
/ FF_NORTC_MDAY and FF_NORTC_YEAR have no effect.
|
||||
/ These options have no effect at read-only configuration (FF_FS_READONLY = 1). */
|
||||
|
||||
|
||||
#define FF_FS_LOCK 0
|
||||
/* The option FF_FS_LOCK switches file lock function to control duplicated file open
|
||||
/ and illegal operation to open objects. This option must be 0 when FF_FS_READONLY
|
||||
/ is 1.
|
||||
/
|
||||
/ 0: Disable file lock function. To avoid volume corruption, application program
|
||||
/ should avoid illegal open, remove and rename to the open objects.
|
||||
/ >0: Enable file lock function. The value defines how many files/sub-directories
|
||||
/ can be opened simultaneously under file lock control. Note that the file
|
||||
/ lock control is independent of re-entrancy. */
|
||||
|
||||
|
||||
#define FF_FS_REENTRANT 0
|
||||
#define FF_FS_TIMEOUT 1000
|
||||
#define FF_SYNC_t HANDLE
|
||||
/* The option FF_FS_REENTRANT switches the re-entrancy (thread safe) of the FatFs
|
||||
/ module itself. Note that regardless of this option, file access to different
|
||||
/ volume is always re-entrant and volume control functions, f_mount(), f_mkfs()
|
||||
/ and f_fdisk() function, are always not re-entrant. Only file/directory access
|
||||
/ to the same volume is under control of this function.
|
||||
/
|
||||
/ 0: Disable re-entrancy. FF_FS_TIMEOUT and FF_SYNC_t have no effect.
|
||||
/ 1: Enable re-entrancy. Also user provided synchronization handlers,
|
||||
/ ff_req_grant(), ff_rel_grant(), ff_del_syncobj() and ff_cre_syncobj()
|
||||
/ function, must be added to the project. Samples are available in
|
||||
/ option/syscall.c.
|
||||
/
|
||||
/ The FF_FS_TIMEOUT defines timeout period in unit of time tick.
|
||||
/ The FF_SYNC_t defines O/S dependent sync object type. e.g. HANDLE, ID, OS_EVENT*,
|
||||
/ SemaphoreHandle_t and etc. A header file for O/S definitions needs to be
|
||||
/ included somewhere in the scope of ff.h. */
|
||||
|
||||
/* #include <windows.h> // O/S definitions */
|
||||
|
||||
|
||||
|
||||
/*--- End of configuration options ---*/
|
File diff suppressed because it is too large
Load diff
|
@ -1,38 +0,0 @@
|
|||
/*-------------------------------------------*/
|
||||
/* Integer type definitions for FatFs module */
|
||||
/*-------------------------------------------*/
|
||||
|
||||
#ifndef _FF_INTEGER
|
||||
#define _FF_INTEGER
|
||||
|
||||
#ifdef _WIN32 /* FatFs development platform */
|
||||
|
||||
#include <windows.h>
|
||||
#include <tchar.h>
|
||||
typedef unsigned __int64 QWORD;
|
||||
|
||||
|
||||
#else /* Embedded platform */
|
||||
|
||||
/* These types MUST be 16-bit or 32-bit */
|
||||
typedef int INT;
|
||||
typedef unsigned int UINT;
|
||||
|
||||
/* This type MUST be 8-bit */
|
||||
typedef unsigned char BYTE;
|
||||
|
||||
/* These types MUST be 16-bit */
|
||||
typedef short SHORT;
|
||||
typedef unsigned short WORD;
|
||||
typedef unsigned short WCHAR;
|
||||
|
||||
/* These types MUST be 32-bit */
|
||||
typedef long LONG;
|
||||
typedef unsigned long DWORD;
|
||||
|
||||
/* This type MUST be 64-bit (Remove this for C89 compatibility) */
|
||||
typedef unsigned long long QWORD;
|
||||
|
||||
#endif
|
||||
|
||||
#endif
|
|
@ -1,745 +0,0 @@
|
|||
/*------------------------------------------------------------------------*/
|
||||
/* LPCXpresso176x: MMCv3/SDv1/SDv2 (SPI mode) control module */
|
||||
/*------------------------------------------------------------------------*/
|
||||
/*
|
||||
/ Copyright (C) 2015, ChaN, all right reserved.
|
||||
/
|
||||
/ * This software is a free software and there is NO WARRANTY.
|
||||
/ * No restriction on use. You can use, modify and redistribute it for
|
||||
/ personal, non-profit or commercial products UNDER YOUR RESPONSIBILITY.
|
||||
/ * Redistributions of source code must retain the above copyright notice.
|
||||
/
|
||||
/-------------------------------------------------------------------------*/
|
||||
|
||||
#define SSP_CH 1 /* SSP channel to use (0:SSP0, 1:SSP1) */
|
||||
|
||||
#define CCLK 100000000UL /* cclk frequency [Hz] */
|
||||
#define PCLK_SSP 50000000UL /* PCLK frequency to be supplied for SSP [Hz] */
|
||||
#define SCLK_FAST 25000000UL /* SCLK frequency under normal operation [Hz] */
|
||||
#define SCLK_SLOW 400000UL /* SCLK frequency under initialization [Hz] */
|
||||
|
||||
//#define MMC_CD (!(FIO2PIN1 & _BV(1))) /* Card detect (yes:true, no:false, default:true) */
|
||||
#define MMC_WP 0 /* Write protected (yes:true, no:false, default:false) */
|
||||
|
||||
#if SSP_CH == 0
|
||||
#define SSPxDR SSP0DR
|
||||
#define SSPxSR SSP0SR
|
||||
#define SSPxCR0 SSP0CR0
|
||||
#define SSPxCR1 SSP0CR1
|
||||
#define SSPxCPSR SSP0CPSR
|
||||
#define CS_LOW() {FIO0CLR2 = _BV(0);} /* Set P0.16 low */
|
||||
#define CS_HIGH() {FIO0SET2 = _BV(0);} /* Set P0.16 high */
|
||||
#define PCSSPx PCSSP0
|
||||
#define PCLKSSPx PCLK_SSP0
|
||||
#define ATTACH_SSP() {\
|
||||
__set_PINSEL(0, 15, 2); /* SCK0 */\
|
||||
__set_PINSEL(0, 17, 2); /* MISO0 */\
|
||||
__set_PINSEL(0, 18, 2); /* MOSI0 */\
|
||||
FIO0DIR |= _BV(16); /* CS# (P0.16) */\
|
||||
}
|
||||
#elif SSP_CH == 1
|
||||
#define SSPxDR SSP1DR
|
||||
#define SSPxSR SSP1SR
|
||||
#define SSPxCR0 SSP1CR0
|
||||
#define SSPxCR1 SSP1CR1
|
||||
#define SSPxCPSR SSP1CPSR
|
||||
#define CS_LOW() {FIO0CLR0 = _BV(6);} /* Set P0.6 low */
|
||||
#define CS_HIGH() {FIO0SET0 = _BV(6);} /* Set P0.6 high */
|
||||
#define PCSSPx PCSSP1
|
||||
#define PCLKSSPx PCLK_SSP1
|
||||
#define ATTACH_SSP() {\
|
||||
__set_PINSEL(0, 7, 2); /* SCK1 */\
|
||||
__set_PINSEL(0, 8, 2); /* MISO1 */\
|
||||
__set_PINSEL(0, 9, 2); /* MOSI1 */\
|
||||
FIO0DIR |= _BV(6); /* CS# (P0.6) */\
|
||||
}
|
||||
#endif
|
||||
|
||||
#if PCLK_SSP * 1 == CCLK
|
||||
#define PCLKDIV_SSP PCLKDIV_1
|
||||
#elif PCLK_SSP * 2 == CCLK
|
||||
#define PCLKDIV_SSP PCLKDIV_2
|
||||
#elif PCLK_SSP * 4 == CCLK
|
||||
#define PCLKDIV_SSP PCLKDIV_4
|
||||
#elif PCLK_SSP * 8 == CCLK
|
||||
#define PCLKDIV_SSP PCLKDIV_8
|
||||
#else
|
||||
#error Invalid CCLK:PCLK_SSP combination.
|
||||
#endif
|
||||
|
||||
|
||||
#define FCLK_FAST() { SSPxCR0 = (SSPxCR0 & 0x00FF) | ((PCLK_SSP / 2 / SCLK_FAST) - 1) << 8; }
|
||||
#define FCLK_SLOW() { SSPxCR0 = (SSPxCR0 & 0x00FF) | ((PCLK_SSP / 2 / SCLK_SLOW) - 1) << 8; }
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------------------
|
||||
|
||||
Module Private Functions
|
||||
|
||||
---------------------------------------------------------------------------*/
|
||||
|
||||
#include "LPC176x.h"
|
||||
#include "diskio.h"
|
||||
|
||||
|
||||
/* MMC/SD command */
|
||||
#define CMD0 (0) /* GO_IDLE_STATE */
|
||||
#define CMD1 (1) /* SEND_OP_COND (MMC) */
|
||||
#define ACMD41 (0x80+41) /* SEND_OP_COND (SDC) */
|
||||
#define CMD8 (8) /* SEND_IF_COND */
|
||||
#define CMD9 (9) /* SEND_CSD */
|
||||
#define CMD10 (10) /* SEND_CID */
|
||||
#define CMD12 (12) /* STOP_TRANSMISSION */
|
||||
#define ACMD13 (0x80+13) /* SD_STATUS (SDC) */
|
||||
#define CMD16 (16) /* SET_BLOCKLEN */
|
||||
#define CMD17 (17) /* READ_SINGLE_BLOCK */
|
||||
#define CMD18 (18) /* READ_MULTIPLE_BLOCK */
|
||||
#define CMD23 (23) /* SET_BLOCK_COUNT (MMC) */
|
||||
#define ACMD23 (0x80+23) /* SET_WR_BLK_ERASE_COUNT (SDC) */
|
||||
#define CMD24 (24) /* WRITE_BLOCK */
|
||||
#define CMD25 (25) /* WRITE_MULTIPLE_BLOCK */
|
||||
#define CMD32 (32) /* ERASE_ER_BLK_START */
|
||||
#define CMD33 (33) /* ERASE_ER_BLK_END */
|
||||
#define CMD38 (38) /* ERASE */
|
||||
#define CMD48 (48) /* READ_EXTR_SINGLE */
|
||||
#define CMD49 (49) /* WRITE_EXTR_SINGLE */
|
||||
#define CMD55 (55) /* APP_CMD */
|
||||
#define CMD58 (58) /* READ_OCR */
|
||||
|
||||
|
||||
static volatile
|
||||
DSTATUS Stat = STA_NOINIT; /* Physical drive status */
|
||||
|
||||
static volatile
|
||||
UINT Timer1, Timer2; /* 1kHz decrement timer stopped at zero (disk_timerproc()) */
|
||||
|
||||
static
|
||||
BYTE CardType; /* Card type flags */
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Send/Receive data to the MMC (Platform dependent) */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
/* Exchange a byte */
|
||||
static
|
||||
BYTE xchg_spi (
|
||||
BYTE dat /* Data to send */
|
||||
)
|
||||
{
|
||||
SSPxDR = dat;
|
||||
while (SSPxSR & 0x10) ;
|
||||
return SSPxDR;
|
||||
}
|
||||
|
||||
|
||||
/* Receive multiple byte */
|
||||
static
|
||||
void rcvr_spi_multi (
|
||||
BYTE *buff, /* Pointer to data buffer */
|
||||
UINT btr /* Number of bytes to receive (16, 64 or 512) */
|
||||
)
|
||||
{
|
||||
UINT n;
|
||||
WORD d;
|
||||
|
||||
|
||||
SSPxCR0 |= 0x000F; /* Select 16-bit mode */
|
||||
|
||||
for (n = 0; n < 8; n++) /* Push 8 frames into pipeline */
|
||||
SSPxDR = 0xFFFF;
|
||||
btr -= 16;
|
||||
|
||||
while (btr >= 2) { /* Receive the data block into buffer */
|
||||
btr -= 2;
|
||||
while (!(SSPxSR & _BV(2))) ; /* Wait for any data in receive FIFO */
|
||||
d = SSPxDR;
|
||||
SSPxDR = 0xFFFF;
|
||||
*buff++ = d >> 8;
|
||||
*buff++ = d;
|
||||
}
|
||||
|
||||
for (n = 0; n < 8; n++) { /* Pop remaining frames from pipeline */
|
||||
while (!(SSPxSR & _BV(2))) ;
|
||||
d = SSPxDR;
|
||||
*buff++ = d >> 8;
|
||||
*buff++ = d;
|
||||
}
|
||||
|
||||
SSPxCR0 &= 0xFFF7; /* Select 8-bit mode */
|
||||
}
|
||||
|
||||
|
||||
#if _DISKIO_WRITE
|
||||
/* Send multiple byte */
|
||||
static
|
||||
void xmit_spi_multi (
|
||||
const BYTE *buff, /* Pointer to the data */
|
||||
UINT btx /* Number of bytes to send (multiple of 16) */
|
||||
)
|
||||
{
|
||||
UINT n;
|
||||
WORD d;
|
||||
|
||||
|
||||
SSPxCR0 |= 0x000F; /* Select 16-bit mode */
|
||||
|
||||
for (n = 0; n < 8; n++) { /* Push 8 frames into pipeline */
|
||||
d = *buff++;
|
||||
d = d << 8 | *buff++;
|
||||
SSPxDR = d;
|
||||
}
|
||||
btx -= 16;
|
||||
|
||||
while (btx >= 2) { /* Transmit data block */
|
||||
btx -= 2;
|
||||
d = *buff++;
|
||||
d = d << 8 | *buff++;
|
||||
while (!(SSPxSR & _BV(2))) ; /* Wait for any data in receive FIFO */
|
||||
SSPxDR; SSPxDR = d;
|
||||
}
|
||||
|
||||
for (n = 0; n < 8; n++) { /* Flush pipeline */
|
||||
while (!(SSPxSR & _BV(2))) ;
|
||||
SSPxDR;
|
||||
}
|
||||
|
||||
SSPxCR0 &= 0xFFF7; /* Select 8-bit mode */
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Wait for card ready */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
int wait_ready ( /* 1:Ready, 0:Timeout */
|
||||
UINT wt /* Timeout [ms] */
|
||||
)
|
||||
{
|
||||
BYTE d;
|
||||
|
||||
|
||||
Timer2 = wt;
|
||||
do {
|
||||
d = xchg_spi(0xFF);
|
||||
|
||||
/* This loop takes a time. Insert rot_rdq() here for multitask envilonment. */
|
||||
|
||||
} while (d != 0xFF && Timer2); /* Wait for card goes ready or timeout */
|
||||
|
||||
return (d == 0xFF) ? 1 : 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Deselect card and release SPI */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
void deselect (void)
|
||||
{
|
||||
CS_HIGH(); /* CS = H */
|
||||
xchg_spi(0xFF); /* Dummy clock (force DO hi-z for multiple slave SPI) */
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Select card and wait for ready */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
int select (void) /* 1:OK, 0:Timeout */
|
||||
{
|
||||
CS_LOW(); /* CS = L */
|
||||
xchg_spi(0xFF); /* Dummy clock (force DO enabled) */
|
||||
|
||||
if (wait_ready(500)) return 1; /* Leading busy check: Wait for card ready */
|
||||
|
||||
deselect(); /* Timeout */
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Control SPI module (Platform dependent) */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
void power_on (void) /* Enable SSP module and attach it to I/O pads */
|
||||
{
|
||||
__set_PCONP(PCSSPx, 1); /* Enable SSP module */
|
||||
__set_PCLKSEL(PCLKSSPx, PCLKDIV_SSP); /* Select PCLK frequency for SSP */
|
||||
SSPxCPSR = 2; /* CPSDVSR=2 */
|
||||
SSPxCR0 = 0x0007; /* Set mode: SPI mode 0, 8-bit */
|
||||
SSPxCR1 = 0x2; /* Enable SSP with Master */
|
||||
ATTACH_SSP(); /* Attach SSP module to I/O pads */
|
||||
CS_HIGH(); /* Set CS# high */
|
||||
|
||||
for (Timer1 = 10; Timer1; ) ; /* 10ms */
|
||||
}
|
||||
|
||||
|
||||
static
|
||||
void power_off (void) /* Disable SPI function */
|
||||
{
|
||||
select(); /* Wait for card ready */
|
||||
deselect();
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Receive a data packet from the MMC */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
int rcvr_datablock ( /* 1:OK, 0:Error */
|
||||
BYTE *buff, /* Data buffer */
|
||||
UINT btr /* Data block length (byte) */
|
||||
)
|
||||
{
|
||||
BYTE token;
|
||||
|
||||
|
||||
Timer1 = 200;
|
||||
do { /* Wait for DataStart token in timeout of 200ms */
|
||||
token = xchg_spi(0xFF);
|
||||
|
||||
/* This loop will take a time. Insert rot_rdq() here for multitask envilonment. */
|
||||
|
||||
} while ((token == 0xFF) && Timer1);
|
||||
if(token != 0xFE) return 0; /* Function fails if invalid DataStart token or timeout */
|
||||
|
||||
rcvr_spi_multi(buff, btr); /* Store trailing data to the buffer */
|
||||
xchg_spi(0xFF); xchg_spi(0xFF); /* Discard CRC */
|
||||
|
||||
return 1; /* Function succeeded */
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Send a data packet to the MMC */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
#if _DISKIO_WRITE
|
||||
static
|
||||
int xmit_datablock ( /* 1:OK, 0:Failed */
|
||||
const BYTE *buff, /* Ponter to 512 byte data to be sent */
|
||||
BYTE token /* Token */
|
||||
)
|
||||
{
|
||||
BYTE resp;
|
||||
|
||||
|
||||
if (!wait_ready(500)) return 0; /* Leading busy check: Wait for card ready to accept data block */
|
||||
|
||||
xchg_spi(token); /* Send token */
|
||||
if (token == 0xFD) return 1; /* Do not send data if token is StopTran */
|
||||
|
||||
xmit_spi_multi(buff, 512); /* Data */
|
||||
xchg_spi(0xFF); xchg_spi(0xFF); /* Dummy CRC */
|
||||
|
||||
resp = xchg_spi(0xFF); /* Receive data resp */
|
||||
|
||||
return (resp & 0x1F) == 0x05 ? 1 : 0; /* Data was accepted or not */
|
||||
|
||||
/* Busy check is done at next transmission */
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Send a command packet to the MMC */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
static
|
||||
BYTE send_cmd ( /* Return value: R1 resp (bit7==1:Failed to send) */
|
||||
BYTE cmd, /* Command index */
|
||||
DWORD arg /* Argument */
|
||||
)
|
||||
{
|
||||
BYTE n, res;
|
||||
|
||||
|
||||
if (cmd & 0x80) { /* Send a CMD55 prior to ACMD<n> */
|
||||
cmd &= 0x7F;
|
||||
res = send_cmd(CMD55, 0);
|
||||
if (res > 1) return res;
|
||||
}
|
||||
|
||||
/* Select the card and wait for ready except to stop multiple block read */
|
||||
if (cmd != CMD12) {
|
||||
deselect();
|
||||
if (!select()) return 0xFF;
|
||||
}
|
||||
|
||||
/* Send command packet */
|
||||
xchg_spi(0x40 | cmd); /* Start + command index */
|
||||
xchg_spi((BYTE)(arg >> 24)); /* Argument[31..24] */
|
||||
xchg_spi((BYTE)(arg >> 16)); /* Argument[23..16] */
|
||||
xchg_spi((BYTE)(arg >> 8)); /* Argument[15..8] */
|
||||
xchg_spi((BYTE)arg); /* Argument[7..0] */
|
||||
n = 0x01; /* Dummy CRC + Stop */
|
||||
if (cmd == CMD0) n = 0x95; /* Valid CRC for CMD0(0) */
|
||||
if (cmd == CMD8) n = 0x87; /* Valid CRC for CMD8(0x1AA) */
|
||||
xchg_spi(n);
|
||||
|
||||
/* Receive command resp */
|
||||
if (cmd == CMD12) xchg_spi(0xFF); /* Diacard following one byte when CMD12 */
|
||||
n = 10; /* Wait for response (10 bytes max) */
|
||||
do
|
||||
res = xchg_spi(0xFF);
|
||||
while ((res & 0x80) && --n);
|
||||
|
||||
return res; /* Return received response */
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*--------------------------------------------------------------------------
|
||||
|
||||
Public Functions
|
||||
|
||||
---------------------------------------------------------------------------*/
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Initialize disk drive */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
DSTATUS disk_initialize (
|
||||
BYTE drv /* Physical drive number (0) */
|
||||
)
|
||||
{
|
||||
BYTE n, cmd, ty, ocr[4];
|
||||
|
||||
|
||||
if (drv) return STA_NOINIT; /* Supports only drive 0 */
|
||||
power_on(); /* Initialize SPI */
|
||||
|
||||
if (Stat & STA_NODISK) return Stat; /* Is a card existing in the soket? */
|
||||
|
||||
FCLK_SLOW();
|
||||
for (n = 10; n; n--) xchg_spi(0xFF); /* Send 80 dummy clocks */
|
||||
|
||||
ty = 0;
|
||||
if (send_cmd(CMD0, 0) == 1) { /* Put the card SPI state */
|
||||
Timer1 = 1000; /* Initialization timeout = 1 sec */
|
||||
if (send_cmd(CMD8, 0x1AA) == 1) { /* Is the catd SDv2? */
|
||||
for (n = 0; n < 4; n++) ocr[n] = xchg_spi(0xFF); /* Get 32 bit return value of R7 resp */
|
||||
if (ocr[2] == 0x01 && ocr[3] == 0xAA) { /* Does the card support 2.7-3.6V? */
|
||||
while (Timer1 && send_cmd(ACMD41, 1UL << 30)) ; /* Wait for end of initialization with ACMD41(HCS) */
|
||||
if (Timer1 && send_cmd(CMD58, 0) == 0) { /* Check CCS bit in the OCR */
|
||||
for (n = 0; n < 4; n++) ocr[n] = xchg_spi(0xFF);
|
||||
ty = (ocr[0] & 0x40) ? CT_SD2 | CT_BLOCK : CT_SD2; /* Check if the card is SDv2 */
|
||||
}
|
||||
}
|
||||
} else { /* Not an SDv2 card */
|
||||
if (send_cmd(ACMD41, 0) <= 1) { /* SDv1 or MMCv3? */
|
||||
ty = CT_SD1; cmd = ACMD41; /* SDv1 (ACMD41(0)) */
|
||||
} else {
|
||||
ty = CT_MMC; cmd = CMD1; /* MMCv3 (CMD1(0)) */
|
||||
}
|
||||
while (Timer1 && send_cmd(cmd, 0)) ; /* Wait for the card leaves idle state */
|
||||
if (!Timer1 || send_cmd(CMD16, 512) != 0) /* Set block length: 512 */
|
||||
ty = 0;
|
||||
}
|
||||
}
|
||||
CardType = ty; /* Card type */
|
||||
deselect();
|
||||
|
||||
if (ty) { /* OK */
|
||||
FCLK_FAST(); /* Set fast clock */
|
||||
Stat &= ~STA_NOINIT; /* Clear STA_NOINIT flag */
|
||||
} else { /* Failed */
|
||||
power_off();
|
||||
Stat = STA_NOINIT;
|
||||
}
|
||||
|
||||
return Stat;
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Get disk status */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
DSTATUS disk_status (
|
||||
BYTE drv /* Physical drive number (0) */
|
||||
)
|
||||
{
|
||||
if (drv) return STA_NOINIT; /* Supports only drive 0 */
|
||||
|
||||
return Stat; /* Return disk status */
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Read sector(s) */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
DRESULT disk_read (
|
||||
BYTE drv, /* Physical drive number (0) */
|
||||
BYTE *buff, /* Pointer to the data buffer to store read data */
|
||||
DWORD sector, /* Start sector number (LBA) */
|
||||
UINT count /* Number of sectors to read (1..128) */
|
||||
)
|
||||
{
|
||||
BYTE cmd;
|
||||
|
||||
|
||||
if (drv || !count) return RES_PARERR; /* Check parameter */
|
||||
if (Stat & STA_NOINIT) return RES_NOTRDY; /* Check if drive is ready */
|
||||
if (!(CardType & CT_BLOCK)) sector *= 512; /* LBA ot BA conversion (byte addressing cards) */
|
||||
|
||||
cmd = count > 1 ? CMD18 : CMD17; /* READ_MULTIPLE_BLOCK : READ_SINGLE_BLOCK */
|
||||
if (send_cmd(cmd, sector) == 0) {
|
||||
do {
|
||||
if (!rcvr_datablock(buff, 512)) break;
|
||||
buff += 512;
|
||||
} while (--count);
|
||||
if (cmd == CMD18) send_cmd(CMD12, 0); /* STOP_TRANSMISSION */
|
||||
}
|
||||
deselect();
|
||||
|
||||
return count ? RES_ERROR : RES_OK; /* Return result */
|
||||
}
|
||||
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Write sector(s) */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
#if _DISKIO_WRITE
|
||||
DRESULT disk_write (
|
||||
BYTE drv, /* Physical drive number (0) */
|
||||
const BYTE *buff, /* Ponter to the data to write */
|
||||
DWORD sector, /* Start sector number (LBA) */
|
||||
UINT count /* Number of sectors to write (1..128) */
|
||||
)
|
||||
{
|
||||
if (drv || !count) return RES_PARERR; /* Check parameter */
|
||||
if (Stat & STA_NOINIT) return RES_NOTRDY; /* Check drive status */
|
||||
if (Stat & STA_PROTECT) return RES_WRPRT; /* Check write protect */
|
||||
|
||||
if (!(CardType & CT_BLOCK)) sector *= 512; /* LBA ==> BA conversion (byte addressing cards) */
|
||||
|
||||
if (count == 1) { /* Single sector write */
|
||||
if ((send_cmd(CMD24, sector) == 0) /* WRITE_BLOCK */
|
||||
&& xmit_datablock(buff, 0xFE)) {
|
||||
count = 0;
|
||||
}
|
||||
}
|
||||
else { /* Multiple sector write */
|
||||
if (CardType & CT_SDC) send_cmd(ACMD23, count); /* Predefine number of sectors */
|
||||
if (send_cmd(CMD25, sector) == 0) { /* WRITE_MULTIPLE_BLOCK */
|
||||
do {
|
||||
if (!xmit_datablock(buff, 0xFC)) break;
|
||||
buff += 512;
|
||||
} while (--count);
|
||||
if (!xmit_datablock(0, 0xFD)) count = 1; /* STOP_TRAN token */
|
||||
}
|
||||
}
|
||||
deselect();
|
||||
|
||||
return count ? RES_ERROR : RES_OK; /* Return result */
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Miscellaneous drive controls other than data read/write */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
|
||||
#if _DISKIO_IOCTL
|
||||
|
||||
DRESULT disk_ioctl (
|
||||
BYTE drv, /* Physical drive number (0) */
|
||||
BYTE cmd, /* Control command code */
|
||||
void *buff /* Pointer to the conrtol data */
|
||||
)
|
||||
{
|
||||
DRESULT res;
|
||||
BYTE n, csd[16], *ptr = buff;
|
||||
DWORD *dp, st, ed, csize;
|
||||
#if _DISKIO_ISDIO
|
||||
SDIO_CMD *sdio = buff;
|
||||
BYTE rc, *buf;
|
||||
UINT dc;
|
||||
#endif
|
||||
|
||||
if (drv) return RES_PARERR; /* Check parameter */
|
||||
if (Stat & STA_NOINIT) return RES_NOTRDY; /* Check if drive is ready */
|
||||
|
||||
res = RES_ERROR;
|
||||
|
||||
switch (cmd) {
|
||||
case CTRL_SYNC: /* Wait for end of internal write process of the drive */
|
||||
if (select()) res = RES_OK;
|
||||
break;
|
||||
|
||||
case GET_SECTOR_COUNT: /* Get drive capacity in unit of sector (DWORD) */
|
||||
if ((send_cmd(CMD9, 0) == 0) && rcvr_datablock(csd, 16)) {
|
||||
if ((csd[0] >> 6) == 1) { /* SDC ver 2.00 */
|
||||
csize = csd[9] + ((WORD)csd[8] << 8) + ((DWORD)(csd[7] & 63) << 16) + 1;
|
||||
*(DWORD*)buff = csize << 10;
|
||||
} else { /* SDC ver 1.XX or MMC ver 3 */
|
||||
n = (csd[5] & 15) + ((csd[10] & 128) >> 7) + ((csd[9] & 3) << 1) + 2;
|
||||
csize = (csd[8] >> 6) + ((WORD)csd[7] << 2) + ((WORD)(csd[6] & 3) << 10) + 1;
|
||||
*(DWORD*)buff = csize << (n - 9);
|
||||
}
|
||||
res = RES_OK;
|
||||
}
|
||||
break;
|
||||
|
||||
case GET_BLOCK_SIZE: /* Get erase block size in unit of sector (DWORD) */
|
||||
if (CardType & CT_SD2) { /* SDC ver 2.00 */
|
||||
if (send_cmd(ACMD13, 0) == 0) { /* Read SD status */
|
||||
xchg_spi(0xFF);
|
||||
if (rcvr_datablock(csd, 16)) { /* Read partial block */
|
||||
for (n = 64 - 16; n; n--) xchg_spi(0xFF); /* Purge trailing data */
|
||||
*(DWORD*)buff = 16UL << (csd[10] >> 4);
|
||||
res = RES_OK;
|
||||
}
|
||||
}
|
||||
} else { /* SDC ver 1.XX or MMC */
|
||||
if ((send_cmd(CMD9, 0) == 0) && rcvr_datablock(csd, 16)) { /* Read CSD */
|
||||
if (CardType & CT_SD1) { /* SDC ver 1.XX */
|
||||
*(DWORD*)buff = (((csd[10] & 63) << 1) + ((WORD)(csd[11] & 128) >> 7) + 1) << ((csd[13] >> 6) - 1);
|
||||
} else { /* MMC */
|
||||
*(DWORD*)buff = ((WORD)((csd[10] & 124) >> 2) + 1) * (((csd[11] & 3) << 3) + ((csd[11] & 224) >> 5) + 1);
|
||||
}
|
||||
res = RES_OK;
|
||||
}
|
||||
}
|
||||
break;
|
||||
|
||||
case CTRL_TRIM: /* Erase a block of sectors (used when _USE_TRIM in ffconf.h is 1) */
|
||||
if (!(CardType & CT_SDC)) break; /* Check if the card is SDC */
|
||||
if (disk_ioctl(drv, MMC_GET_CSD, csd)) break; /* Get CSD */
|
||||
if (!(csd[0] >> 6) && !(csd[10] & 0x40)) break; /* Check if sector erase can be applied to the card */
|
||||
dp = buff; st = dp[0]; ed = dp[1]; /* Load sector block */
|
||||
if (!(CardType & CT_BLOCK)) {
|
||||
st *= 512; ed *= 512;
|
||||
}
|
||||
if (send_cmd(CMD32, st) == 0 && send_cmd(CMD33, ed) == 0 && send_cmd(CMD38, 0) == 0 && wait_ready(30000)) { /* Erase sector block */
|
||||
res = RES_OK; /* FatFs does not check result of this command */
|
||||
}
|
||||
break;
|
||||
|
||||
/* Following commands are never used by FatFs module */
|
||||
|
||||
case MMC_GET_TYPE: /* Get MMC/SDC type (BYTE) */
|
||||
*ptr = CardType;
|
||||
res = RES_OK;
|
||||
break;
|
||||
|
||||
case MMC_GET_CSD: /* Read CSD (16 bytes) */
|
||||
if (send_cmd(CMD9, 0) == 0 && rcvr_datablock(ptr, 16)) { /* READ_CSD */
|
||||
res = RES_OK;
|
||||
}
|
||||
break;
|
||||
|
||||
case MMC_GET_CID: /* Read CID (16 bytes) */
|
||||
if (send_cmd(CMD10, 0) == 0 && rcvr_datablock(ptr, 16)) { /* READ_CID */
|
||||
res = RES_OK;
|
||||
}
|
||||
break;
|
||||
|
||||
case MMC_GET_OCR: /* Read OCR (4 bytes) */
|
||||
if (send_cmd(CMD58, 0) == 0) { /* READ_OCR */
|
||||
for (n = 4; n; n--) *ptr++ = xchg_spi(0xFF);
|
||||
res = RES_OK;
|
||||
}
|
||||
break;
|
||||
|
||||
case MMC_GET_SDSTAT: /* Read SD status (64 bytes) */
|
||||
if (send_cmd(ACMD13, 0) == 0) { /* SD_STATUS */
|
||||
xchg_spi(0xFF);
|
||||
if (rcvr_datablock(ptr, 64)) res = RES_OK;
|
||||
}
|
||||
break;
|
||||
#if _DISKIO_ISDIO
|
||||
case ISDIO_READ:
|
||||
sdio = buff;
|
||||
if (send_cmd(CMD48, 0x80000000 | sdio->func << 28 | sdio->addr << 9 | ((sdio->ndata - 1) & 0x1FF)) == 0) {
|
||||
for (Timer1 = 1000; (rc = xchg_spi(0xFF)) == 0xFF && Timer1; ) ;
|
||||
if (rc == 0xFE) {
|
||||
for (buf = sdio->data, dc = sdio->ndata; dc; dc--) *buf++ = xchg_spi(0xFF);
|
||||
for (dc = 514 - sdio->ndata; dc; dc--) xchg_spi(0xFF);
|
||||
res = RES_OK;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case ISDIO_WRITE:
|
||||
sdio = buff;
|
||||
if (send_cmd(CMD49, 0x80000000 | sdio->func << 28 | sdio->addr << 9 | ((sdio->ndata - 1) & 0x1FF)) == 0) {
|
||||
xchg_spi(0xFF); xchg_spi(0xFE);
|
||||
for (buf = sdio->data, dc = sdio->ndata; dc; dc--) xchg_spi(*buf++);
|
||||
for (dc = 514 - sdio->ndata; dc; dc--) xchg_spi(0xFF);
|
||||
if ((xchg_spi(0xFF) & 0x1F) == 0x05) res = RES_OK;
|
||||
}
|
||||
break;
|
||||
case ISDIO_MRITE:
|
||||
sdio = buff;
|
||||
if (send_cmd(CMD49, 0x84000000 | sdio->func << 28 | sdio->addr << 9 | sdio->ndata >> 8) == 0) {
|
||||
xchg_spi(0xFF); xchg_spi(0xFE);
|
||||
xchg_spi(sdio->ndata);
|
||||
for (dc = 513; dc; dc--) xchg_spi(0xFF);
|
||||
if ((xchg_spi(0xFF) & 0x1F) == 0x05) res = RES_OK;
|
||||
}
|
||||
break;
|
||||
#endif
|
||||
default:
|
||||
res = RES_PARERR;
|
||||
}
|
||||
|
||||
deselect();
|
||||
return res;
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* Device timer function */
|
||||
/*-----------------------------------------------------------------------*/
|
||||
/* This function must be called from timer interrupt routine in period
|
||||
/ of 1 ms to generate card control timing.
|
||||
*/
|
||||
|
||||
void disk_timerproc (void)
|
||||
{
|
||||
WORD n;
|
||||
BYTE s;
|
||||
|
||||
|
||||
n = Timer1; /* 1kHz decrement timer stopped at 0 */
|
||||
if (n) Timer1 = --n;
|
||||
n = Timer2;
|
||||
if (n) Timer2 = --n;
|
||||
|
||||
s = Stat;
|
||||
if (MMC_WP) { /* Write protected */
|
||||
s |= STA_PROTECT;
|
||||
} else { /* Write enabled */
|
||||
s &= ~STA_PROTECT;
|
||||
}
|
||||
//if (MMC_CD) { /* Card is in socket */
|
||||
s &= ~STA_NODISK;
|
||||
//} else { /* Socket empty */
|
||||
// s |= (STA_NODISK | STA_NOINIT);
|
||||
//}
|
||||
Stat = s;
|
||||
}
|
||||
|
|
@ -1,91 +0,0 @@
|
|||
/*------------------------------------------------------------------------/
|
||||
/ LPC176x RTC control module
|
||||
/-------------------------------------------------------------------------/
|
||||
/
|
||||
/ Copyright (C) 2011, ChaN, all right reserved.
|
||||
/
|
||||
/ * This software is a free software and there is NO WARRANTY.
|
||||
/ * No restriction on use. You can use, modify and redistribute it for
|
||||
/ personal, non-profit or commercial products UNDER YOUR RESPONSIBILITY.
|
||||
/ * Redistributions of source code must retain the above copyright notice.
|
||||
/
|
||||
/-------------------------------------------------------------------------*/
|
||||
|
||||
#include "rtc176x.h"
|
||||
|
||||
|
||||
int rtc_initialize (void)
|
||||
{
|
||||
/* Enable PCLK to the RTC */
|
||||
__set_PCONP(PCRTC, 1);
|
||||
|
||||
/* Start RTC with external XTAL */
|
||||
RTC_CCR = 0x11;
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
int rtc_gettime (RTC *rtc) /* 1:RTC valid, 0:RTC volatiled */
|
||||
{
|
||||
DWORD d, t;
|
||||
|
||||
|
||||
do {
|
||||
t = RTC_CTIME0;
|
||||
d = RTC_CTIME1;
|
||||
} while (t != RTC_CTIME0 || d != RTC_CTIME1);
|
||||
|
||||
if (RTC_AUX & _BV(4)) { /* If power fail has been detected, return default time. */
|
||||
rtc->sec = 0; rtc->min = 0; rtc->hour = 0;
|
||||
rtc->wday = 0; rtc->mday = 1; rtc->month = 1; rtc->year = 2014;
|
||||
return 0;
|
||||
}
|
||||
|
||||
rtc->sec = t & 63;
|
||||
rtc->min = (t >> 8) & 63;
|
||||
rtc->hour = (t >> 16) & 31;
|
||||
rtc->wday = (t >> 24) & 7;
|
||||
rtc->mday = d & 31;
|
||||
rtc->month = (d >> 8) & 15;
|
||||
rtc->year = (d >> 16) & 4095;
|
||||
return 1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
int rtc_settime (const RTC *rtc)
|
||||
{
|
||||
RTC_CCR = 0x12; /* Stop RTC */
|
||||
|
||||
/* Update RTC registers */
|
||||
RTC_SEC = rtc->sec;
|
||||
RTC_MIN = rtc->min;
|
||||
RTC_HOUR = rtc->hour;
|
||||
RTC_DOW = rtc->wday;
|
||||
RTC_DOM = rtc->mday;
|
||||
RTC_MONTH = rtc->month;
|
||||
RTC_YEAR = rtc->year;
|
||||
|
||||
RTC_AUX = _BV(4); /* Clear power fail flag */
|
||||
RTC_CCR = 0x11; /* Restart RTC, Disable calibration feature */
|
||||
|
||||
return 1;
|
||||
}
|
||||
|
||||
DWORD get_fattime (void) {
|
||||
RTC rtc;
|
||||
|
||||
/* Get local time */
|
||||
rtc_gettime(&rtc);
|
||||
|
||||
/* Pack date and time into a DWORD variable */
|
||||
return ((DWORD)(rtc.year - 1980) << 25)
|
||||
| ((DWORD)rtc.month << 21)
|
||||
| ((DWORD)rtc.mday << 16)
|
||||
| ((DWORD)rtc.hour << 11)
|
||||
| ((DWORD)rtc.min << 5)
|
||||
| ((DWORD)rtc.sec >> 1);
|
||||
}
|
|
@ -1,22 +0,0 @@
|
|||
#ifndef _RTC_DEFINED
|
||||
#define _RTC_DEFINE
|
||||
|
||||
#include "integer.h"
|
||||
#include "LPC176x.h"
|
||||
|
||||
typedef struct {
|
||||
WORD year; /* 1..4095 */
|
||||
BYTE month; /* 1..12 */
|
||||
BYTE mday; /* 1.. 31 */
|
||||
BYTE wday; /* 1..7 */
|
||||
BYTE hour; /* 0..23 */
|
||||
BYTE min; /* 0..59 */
|
||||
BYTE sec; /* 0..59 */
|
||||
} RTC;
|
||||
|
||||
int rtc_initialize (void); /* Initialize RTC */
|
||||
int rtc_gettime (RTC*); /* Get time */
|
||||
int rtc_settime (const RTC*); /* Set time */
|
||||
DWORD get_fattime (void);
|
||||
|
||||
#endif
|
|
@ -1,180 +0,0 @@
|
|||
/* Linker script for mbed LPC1768 */
|
||||
MEMORY
|
||||
{
|
||||
/* FLASH (rx) : ORIGIN = 0x00000000, LENGTH = 512K */
|
||||
FLASH (rx) : ORIGIN = 16K, LENGTH = (512K - 16K)
|
||||
RAM (rwx) : ORIGIN = 0x100000C8, LENGTH = (32K - 0xC8)
|
||||
|
||||
USB_RAM(rwx) : ORIGIN = 0x2007C000, LENGTH = 16K
|
||||
ETH_RAM(rwx) : ORIGIN = 0x20080000, LENGTH = 16K
|
||||
}
|
||||
|
||||
/* Linker script to place sections and symbol values. Should be used together
|
||||
* with other linker script that defines memory regions FLASH and RAM.
|
||||
* It references following symbols, which must be defined in code:
|
||||
* Reset_Handler : Entry of reset handler
|
||||
*
|
||||
* It defines following symbols, which code can use without definition:
|
||||
* __exidx_start
|
||||
* __exidx_end
|
||||
* __etext
|
||||
* __data_start__
|
||||
* __preinit_array_start
|
||||
* __preinit_array_end
|
||||
* __init_array_start
|
||||
* __init_array_end
|
||||
* __fini_array_start
|
||||
* __fini_array_end
|
||||
* __data_end__
|
||||
* __bss_start__
|
||||
* __bss_end__
|
||||
* __end__
|
||||
* end
|
||||
* __HeapLimit
|
||||
* __StackLimit
|
||||
* __StackTop
|
||||
* __stack
|
||||
*/
|
||||
ENTRY(Reset_Handler)
|
||||
|
||||
SECTIONS
|
||||
{
|
||||
.text :
|
||||
{
|
||||
KEEP(*(.isr_vector))
|
||||
*(.text*)
|
||||
|
||||
KEEP(*(.init))
|
||||
KEEP(*(.fini))
|
||||
|
||||
/* .ctors */
|
||||
*crtbegin.o(.ctors)
|
||||
*crtbegin?.o(.ctors)
|
||||
*(EXCLUDE_FILE(*crtend?.o *crtend.o) .ctors)
|
||||
*(SORT(.ctors.*))
|
||||
*(.ctors)
|
||||
|
||||
/* .dtors */
|
||||
*crtbegin.o(.dtors)
|
||||
*crtbegin?.o(.dtors)
|
||||
*(EXCLUDE_FILE(*crtend?.o *crtend.o) .dtors)
|
||||
*(SORT(.dtors.*))
|
||||
*(.dtors)
|
||||
|
||||
*(.rodata*)
|
||||
|
||||
KEEP(*(.eh_frame*))
|
||||
} > FLASH
|
||||
|
||||
.ARM.extab :
|
||||
{
|
||||
*(.ARM.extab* .gnu.linkonce.armextab.*)
|
||||
} > FLASH
|
||||
|
||||
__exidx_start = .;
|
||||
.ARM.exidx :
|
||||
{
|
||||
*(.ARM.exidx* .gnu.linkonce.armexidx.*)
|
||||
} > FLASH
|
||||
__exidx_end = .;
|
||||
|
||||
__etext = .;
|
||||
|
||||
.data : AT (__etext)
|
||||
{
|
||||
__data_start__ = .;
|
||||
Image$$RW_IRAM1$$Base = .;
|
||||
*(vtable)
|
||||
*(.data*)
|
||||
|
||||
. = ALIGN(4);
|
||||
/* preinit data */
|
||||
PROVIDE (__preinit_array_start = .);
|
||||
KEEP(*(.preinit_array))
|
||||
PROVIDE (__preinit_array_end = .);
|
||||
|
||||
. = ALIGN(4);
|
||||
/* init data */
|
||||
PROVIDE (__init_array_start = .);
|
||||
KEEP(*(SORT(.init_array.*)))
|
||||
KEEP(*(.init_array))
|
||||
PROVIDE (__init_array_end = .);
|
||||
|
||||
|
||||
. = ALIGN(4);
|
||||
/* finit data */
|
||||
PROVIDE (__fini_array_start = .);
|
||||
KEEP(*(SORT(.fini_array.*)))
|
||||
KEEP(*(.fini_array))
|
||||
PROVIDE (__fini_array_end = .);
|
||||
|
||||
. = ALIGN(4);
|
||||
/* All data end */
|
||||
__data_end__ = .;
|
||||
|
||||
} > RAM
|
||||
|
||||
.bss :
|
||||
{
|
||||
__bss_start__ = .;
|
||||
*(.bss*)
|
||||
*(COMMON)
|
||||
__bss_end__ = .;
|
||||
Image$$RW_IRAM1$$ZI$$Limit = . ;
|
||||
} > RAM
|
||||
|
||||
.heap :
|
||||
{
|
||||
__end__ = .;
|
||||
end = __end__;
|
||||
*(.heap*)
|
||||
__HeapLimit = .;
|
||||
} > RAM
|
||||
|
||||
/* .stack_dummy section doesn't contains any symbols. It is only
|
||||
* used for linker to calculate size of stack sections, and assign
|
||||
* values to stack symbols later */
|
||||
.stack_dummy :
|
||||
{
|
||||
*(.stack)
|
||||
} > RAM
|
||||
|
||||
/* Set stack top to end of RAM, and stack limit move down by
|
||||
* size of stack_dummy section */
|
||||
__StackTop = ORIGIN(RAM) + LENGTH(RAM);
|
||||
__StackLimit = __StackTop - SIZEOF(.stack_dummy);
|
||||
PROVIDE(__stack = __StackTop);
|
||||
PROVIDE(__heapLimit = __HeapLimit);
|
||||
PROVIDE(__stackSize = __StackTop - __HeapLimit);
|
||||
|
||||
/* Area of memory, heap and stack, to fill on startup - 8 bytes at a time. */
|
||||
__FillStart = ALIGN(__end__, 8);
|
||||
|
||||
/* Check if data + heap + stack exceeds RAM limit */
|
||||
ASSERT(__StackLimit >= __HeapLimit, "region RAM overflowed with stack")
|
||||
|
||||
|
||||
/* Code can explicitly ask for data to be
|
||||
placed in these higher RAM banks where
|
||||
they will be left uninitialized.
|
||||
*/
|
||||
.AHBSRAM0 (NOLOAD):
|
||||
{
|
||||
Image$$RW_IRAM2$$Base = . ;
|
||||
PROVIDE(__AHB0_block_start = .);
|
||||
*(AHBSRAM0)
|
||||
Image$$RW_IRAM2$$ZI$$Limit = .;
|
||||
PROVIDE(__AHB0_dyn_start = .);
|
||||
PROVIDE(__AHB0_end = ORIGIN(USB_RAM) + LENGTH(USB_RAM));
|
||||
} > USB_RAM
|
||||
|
||||
.AHBSRAM1 (NOLOAD):
|
||||
{
|
||||
Image$$RW_IRAM3$$Base = . ;
|
||||
PROVIDE(__AHB1_block_start = .);
|
||||
*(AHBSRAM1)
|
||||
Image$$RW_IRAM3$$ZI$$Limit = .;
|
||||
PROVIDE(__AHB1_dyn_start = .);
|
||||
PROVIDE(__AHB1_end = ORIGIN(ETH_RAM) + LENGTH(ETH_RAM));
|
||||
} > ETH_RAM
|
||||
}
|
|
@ -1,223 +0,0 @@
|
|||
/* File: startup_ARMCM3.s
|
||||
* Purpose: startup file for Cortex-M3/M4 devices. Should use with
|
||||
* GNU Tools for ARM Embedded Processors
|
||||
* Version: V1.1
|
||||
* Date: 17 June 2011
|
||||
*
|
||||
* Copyright (C) 2011 ARM Limited. All rights reserved.
|
||||
* ARM Limited (ARM) is supplying this software for use with Cortex-M3/M4
|
||||
* processor based microcontrollers. This file can be freely distributed
|
||||
* within development tools that are supporting such ARM based processors.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED "AS IS". NO WARRANTIES, WHETHER EXPRESS, IMPLIED
|
||||
* OR STATUTORY, INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF
|
||||
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE.
|
||||
* ARM SHALL NOT, IN ANY CIRCUMSTANCES, BE LIABLE FOR SPECIAL, INCIDENTAL, OR
|
||||
* CONSEQUENTIAL DAMAGES, FOR ANY REASON WHATSOEVER.
|
||||
*/
|
||||
.syntax unified
|
||||
.arch armv7-m
|
||||
|
||||
/* Memory Model
|
||||
The HEAP starts at the end of the DATA section and grows upward.
|
||||
|
||||
The STACK starts at the end of the RAM and grows downward.
|
||||
|
||||
The HEAP and stack STACK are only checked at compile time:
|
||||
(DATA_SIZE + HEAP_SIZE + STACK_SIZE) < RAM_SIZE
|
||||
|
||||
This is just a check for the bare minimum for the Heap+Stack area before
|
||||
aborting compilation, it is not the run time limit:
|
||||
Heap_Size + Stack_Size = 0x80 + 0x80 = 0x100
|
||||
*/
|
||||
.section .stack
|
||||
.align 3
|
||||
#ifdef __STACK_SIZE
|
||||
.equ Stack_Size, __STACK_SIZE
|
||||
#else
|
||||
.equ Stack_Size, 0xc00
|
||||
#endif
|
||||
.globl __StackTop
|
||||
.globl __StackLimit
|
||||
__StackLimit:
|
||||
.space Stack_Size
|
||||
.size __StackLimit, . - __StackLimit
|
||||
__StackTop:
|
||||
.size __StackTop, . - __StackTop
|
||||
|
||||
.section .heap
|
||||
.align 3
|
||||
#ifdef __HEAP_SIZE
|
||||
.equ Heap_Size, __HEAP_SIZE
|
||||
#else
|
||||
.equ Heap_Size, 0x800
|
||||
#endif
|
||||
.globl __HeapBase
|
||||
.globl __HeapLimit
|
||||
__HeapBase:
|
||||
.space Heap_Size
|
||||
.size __HeapBase, . - __HeapBase
|
||||
__HeapLimit:
|
||||
.size __HeapLimit, . - __HeapLimit
|
||||
|
||||
.section .isr_vector
|
||||
.align 2
|
||||
.globl __isr_vector
|
||||
__isr_vector:
|
||||
.long __StackTop /* Top of Stack */
|
||||
.long Reset_Handler /* Reset Handler */
|
||||
.long NMI_Handler /* NMI Handler */
|
||||
.long HardFault_Handler /* Hard Fault Handler */
|
||||
.long MemManage_Handler /* MPU Fault Handler */
|
||||
.long BusFault_Handler /* Bus Fault Handler */
|
||||
.long UsageFault_Handler /* Usage Fault Handler */
|
||||
.long 0 /* Reserved */
|
||||
.long 0 /* Reserved */
|
||||
.long 0 /* Reserved */
|
||||
.long 0 /* Reserved */
|
||||
.long SVC_Handler /* SVCall Handler */
|
||||
.long DebugMon_Handler /* Debug Monitor Handler */
|
||||
.long 0 /* Reserved */
|
||||
.long PendSV_Handler /* PendSV Handler */
|
||||
.long SysTick_Handler /* SysTick Handler */
|
||||
|
||||
/* External interrupts */
|
||||
.long WDT_IRQHandler /* 16: Watchdog Timer */
|
||||
.long TIMER0_IRQHandler /* 17: Timer0 */
|
||||
.long TIMER1_IRQHandler /* 18: Timer1 */
|
||||
.long TIMER2_IRQHandler /* 19: Timer2 */
|
||||
.long TIMER3_IRQHandler /* 20: Timer3 */
|
||||
.long UART0_IRQHandler /* 21: UART0 */
|
||||
.long UART1_IRQHandler /* 22: UART1 */
|
||||
.long UART2_IRQHandler /* 23: UART2 */
|
||||
.long UART3_IRQHandler /* 24: UART3 */
|
||||
.long PWM1_IRQHandler /* 25: PWM1 */
|
||||
.long I2C0_IRQHandler /* 26: I2C0 */
|
||||
.long I2C1_IRQHandler /* 27: I2C1 */
|
||||
.long I2C2_IRQHandler /* 28: I2C2 */
|
||||
.long SPI_IRQHandler /* 29: SPI */
|
||||
.long SSP0_IRQHandler /* 30: SSP0 */
|
||||
.long SSP1_IRQHandler /* 31: SSP1 */
|
||||
.long PLL0_IRQHandler /* 32: PLL0 Lock (Main PLL) */
|
||||
.long RTC_IRQHandler /* 33: Real Time Clock */
|
||||
.long EINT0_IRQHandler /* 34: External Interrupt 0 */
|
||||
.long EINT1_IRQHandler /* 35: External Interrupt 1 */
|
||||
.long EINT2_IRQHandler /* 36: External Interrupt 2 */
|
||||
.long EINT3_IRQHandler /* 37: External Interrupt 3 */
|
||||
.long ADC_IRQHandler /* 38: A/D Converter */
|
||||
.long BOD_IRQHandler /* 39: Brown-Out Detect */
|
||||
.long USB_IRQHandler /* 40: USB */
|
||||
.long CAN_IRQHandler /* 41: CAN */
|
||||
.long DMA_IRQHandler /* 42: General Purpose DMA */
|
||||
.long I2S_IRQHandler /* 43: I2S */
|
||||
.long ENET_IRQHandler /* 44: Ethernet */
|
||||
.long RIT_IRQHandler /* 45: Repetitive Interrupt Timer */
|
||||
.long MCPWM_IRQHandler /* 46: Motor Control PWM */
|
||||
.long QEI_IRQHandler /* 47: Quadrature Encoder Interface */
|
||||
.long PLL1_IRQHandler /* 48: PLL1 Lock (USB PLL) */
|
||||
.long USBActivity_IRQHandler /* 49: USB Activity */
|
||||
.long CANActivity_IRQHandler /* 50: CAN Activity */
|
||||
|
||||
.size __isr_vector, . - __isr_vector
|
||||
|
||||
.text
|
||||
.thumb
|
||||
.thumb_func
|
||||
.align 2
|
||||
.globl Reset_Handler
|
||||
.type Reset_Handler, %function
|
||||
Reset_Handler:
|
||||
/* Loop to copy data from read only memory to RAM. The ranges
|
||||
* of copy from/to are specified by following symbols evaluated in
|
||||
* linker script.
|
||||
* _etext: End of code section, i.e., begin of data sections to copy from.
|
||||
* __data_start__/__data_end__: RAM address range that data should be
|
||||
* copied to. Both must be aligned to 4 bytes boundary. */
|
||||
|
||||
ldr r1, =__etext
|
||||
ldr r2, =__data_start__
|
||||
ldr r3, =__data_end__
|
||||
|
||||
.Lflash_to_ram_loop:
|
||||
cmp r2, r3
|
||||
ittt lt
|
||||
ldrlt r0, [r1], #4
|
||||
strlt r0, [r2], #4
|
||||
blt .Lflash_to_ram_loop
|
||||
|
||||
ldr r0, =SystemInit
|
||||
blx r0
|
||||
ldr r0, =_start
|
||||
bx r0
|
||||
.pool
|
||||
.size Reset_Handler, . - Reset_Handler
|
||||
|
||||
.text
|
||||
/* Macro to define default handlers. Default handler
|
||||
* will be weak symbol and just dead loops. They can be
|
||||
* overwritten by other handlers */
|
||||
.macro def_default_handler handler_name
|
||||
.align 1
|
||||
.thumb_func
|
||||
.weak \handler_name
|
||||
.type \handler_name, %function
|
||||
\handler_name :
|
||||
b .
|
||||
.size \handler_name, . - \handler_name
|
||||
.endm
|
||||
|
||||
def_default_handler NMI_Handler
|
||||
def_default_handler HardFault_Handler
|
||||
def_default_handler MemManage_Handler
|
||||
def_default_handler BusFault_Handler
|
||||
def_default_handler UsageFault_Handler
|
||||
def_default_handler SVC_Handler
|
||||
def_default_handler DebugMon_Handler
|
||||
def_default_handler PendSV_Handler
|
||||
def_default_handler SysTick_Handler
|
||||
def_default_handler Default_Handler
|
||||
|
||||
.macro def_irq_default_handler handler_name
|
||||
.weak \handler_name
|
||||
.set \handler_name, Default_Handler
|
||||
.endm
|
||||
|
||||
def_irq_default_handler WDT_IRQHandler
|
||||
def_irq_default_handler TIMER0_IRQHandler
|
||||
def_irq_default_handler TIMER1_IRQHandler
|
||||
def_irq_default_handler TIMER2_IRQHandler
|
||||
def_irq_default_handler TIMER3_IRQHandler
|
||||
def_irq_default_handler UART0_IRQHandler
|
||||
def_irq_default_handler UART1_IRQHandler
|
||||
def_irq_default_handler UART2_IRQHandler
|
||||
def_irq_default_handler UART3_IRQHandler
|
||||
def_irq_default_handler PWM1_IRQHandler
|
||||
def_irq_default_handler I2C0_IRQHandler
|
||||
def_irq_default_handler I2C1_IRQHandler
|
||||
def_irq_default_handler I2C2_IRQHandler
|
||||
def_irq_default_handler SPI_IRQHandler
|
||||
def_irq_default_handler SSP0_IRQHandler
|
||||
def_irq_default_handler SSP1_IRQHandler
|
||||
def_irq_default_handler PLL0_IRQHandler
|
||||
def_irq_default_handler RTC_IRQHandler
|
||||
def_irq_default_handler EINT0_IRQHandler
|
||||
def_irq_default_handler EINT1_IRQHandler
|
||||
def_irq_default_handler EINT2_IRQHandler
|
||||
def_irq_default_handler EINT3_IRQHandler
|
||||
def_irq_default_handler ADC_IRQHandler
|
||||
def_irq_default_handler BOD_IRQHandler
|
||||
def_irq_default_handler USB_IRQHandler
|
||||
def_irq_default_handler CAN_IRQHandler
|
||||
def_irq_default_handler DMA_IRQHandler
|
||||
def_irq_default_handler I2S_IRQHandler
|
||||
def_irq_default_handler ENET_IRQHandler
|
||||
def_irq_default_handler RIT_IRQHandler
|
||||
def_irq_default_handler MCPWM_IRQHandler
|
||||
def_irq_default_handler QEI_IRQHandler
|
||||
def_irq_default_handler PLL1_IRQHandler
|
||||
def_irq_default_handler USBActivity_IRQHandler
|
||||
def_irq_default_handler CANActivity_IRQHandler
|
||||
def_irq_default_handler DEF_IRQHandler
|
||||
|
||||
.end
|
||||
|
|
@ -1,584 +0,0 @@
|
|||
/**************************************************************************//**
|
||||
* @file system_LPC17xx.c
|
||||
* @brief CMSIS Cortex-M3 Device System Source File for
|
||||
* NXP LPC17xx Device Series
|
||||
* @version V1.11
|
||||
* @date 21. June 2011
|
||||
*
|
||||
* @note
|
||||
* Copyright (C) 2009-2011 ARM Limited. All rights reserved.
|
||||
*
|
||||
* @par
|
||||
* ARM Limited (ARM) is supplying this software for use with Cortex-M
|
||||
* processor based microcontrollers. This file can be freely distributed
|
||||
* within development tools that are supporting such ARM based processors.
|
||||
*
|
||||
* @par
|
||||
* THIS SOFTWARE IS PROVIDED "AS IS". NO WARRANTIES, WHETHER EXPRESS, IMPLIED
|
||||
* OR STATUTORY, INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF
|
||||
* MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE.
|
||||
* ARM SHALL NOT, IN ANY CIRCUMSTANCES, BE LIABLE FOR SPECIAL, INCIDENTAL, OR
|
||||
* CONSEQUENTIAL DAMAGES, FOR ANY REASON WHATSOEVER.
|
||||
*
|
||||
******************************************************************************/
|
||||
|
||||
|
||||
#include <stdint.h>
|
||||
#include "LPC17xx.h"
|
||||
|
||||
|
||||
/** @addtogroup LPC17xx_System
|
||||
* @{
|
||||
*/
|
||||
|
||||
/*
|
||||
//-------- <<< Use Configuration Wizard in Context Menu >>> ------------------
|
||||
*/
|
||||
|
||||
/*--------------------- Clock Configuration ----------------------------------
|
||||
//
|
||||
// <e> Clock Configuration
|
||||
// <h> System Controls and Status Register (SCS)
|
||||
// <o1.4> OSCRANGE: Main Oscillator Range Select
|
||||
// <0=> 1 MHz to 20 MHz
|
||||
// <1=> 15 MHz to 25 MHz
|
||||
// <e1.5> OSCEN: Main Oscillator Enable
|
||||
// </e>
|
||||
// </h>
|
||||
//
|
||||
// <h> Clock Source Select Register (CLKSRCSEL)
|
||||
// <o2.0..1> CLKSRC: PLL Clock Source Selection
|
||||
// <0=> Internal RC oscillator
|
||||
// <1=> Main oscillator
|
||||
// <2=> RTC oscillator
|
||||
// </h>
|
||||
//
|
||||
// <e3> PLL0 Configuration (Main PLL)
|
||||
// <h> PLL0 Configuration Register (PLL0CFG)
|
||||
// <i> F_cco0 = (2 * M * F_in) / N
|
||||
// <i> F_in must be in the range of 32 kHz to 50 MHz
|
||||
// <i> F_cco0 must be in the range of 275 MHz to 550 MHz
|
||||
// <o4.0..14> MSEL: PLL Multiplier Selection
|
||||
// <6-32768><#-1>
|
||||
// <i> M Value
|
||||
// <o4.16..23> NSEL: PLL Divider Selection
|
||||
// <1-256><#-1>
|
||||
// <i> N Value
|
||||
// </h>
|
||||
// </e>
|
||||
//
|
||||
// <e5> PLL1 Configuration (USB PLL)
|
||||
// <h> PLL1 Configuration Register (PLL1CFG)
|
||||
// <i> F_usb = M * F_osc or F_usb = F_cco1 / (2 * P)
|
||||
// <i> F_cco1 = F_osc * M * 2 * P
|
||||
// <i> F_cco1 must be in the range of 156 MHz to 320 MHz
|
||||
// <o6.0..4> MSEL: PLL Multiplier Selection
|
||||
// <1-32><#-1>
|
||||
// <i> M Value (for USB maximum value is 4)
|
||||
// <o6.5..6> PSEL: PLL Divider Selection
|
||||
// <0=> 1
|
||||
// <1=> 2
|
||||
// <2=> 4
|
||||
// <3=> 8
|
||||
// <i> P Value
|
||||
// </h>
|
||||
// </e>
|
||||
//
|
||||
// <h> CPU Clock Configuration Register (CCLKCFG)
|
||||
// <o7.0..7> CCLKSEL: Divide Value for CPU Clock from PLL0
|
||||
// <1-256><#-1>
|
||||
// </h>
|
||||
//
|
||||
// <h> USB Clock Configuration Register (USBCLKCFG)
|
||||
// <o8.0..3> USBSEL: Divide Value for USB Clock from PLL0
|
||||
// <0-15>
|
||||
// <i> Divide is USBSEL + 1
|
||||
// </h>
|
||||
//
|
||||
// <h> Peripheral Clock Selection Register 0 (PCLKSEL0)
|
||||
// <o9.0..1> PCLK_WDT: Peripheral Clock Selection for WDT
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.2..3> PCLK_TIMER0: Peripheral Clock Selection for TIMER0
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.4..5> PCLK_TIMER1: Peripheral Clock Selection for TIMER1
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.6..7> PCLK_UART0: Peripheral Clock Selection for UART0
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.8..9> PCLK_UART1: Peripheral Clock Selection for UART1
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.12..13> PCLK_PWM1: Peripheral Clock Selection for PWM1
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.14..15> PCLK_I2C0: Peripheral Clock Selection for I2C0
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.16..17> PCLK_SPI: Peripheral Clock Selection for SPI
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.20..21> PCLK_SSP1: Peripheral Clock Selection for SSP1
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.22..23> PCLK_DAC: Peripheral Clock Selection for DAC
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.24..25> PCLK_ADC: Peripheral Clock Selection for ADC
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o9.26..27> PCLK_CAN1: Peripheral Clock Selection for CAN1
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 6
|
||||
// <o9.28..29> PCLK_CAN2: Peripheral Clock Selection for CAN2
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 6
|
||||
// <o9.30..31> PCLK_ACF: Peripheral Clock Selection for ACF
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 6
|
||||
// </h>
|
||||
//
|
||||
// <h> Peripheral Clock Selection Register 1 (PCLKSEL1)
|
||||
// <o10.0..1> PCLK_QEI: Peripheral Clock Selection for the Quadrature Encoder Interface
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.2..3> PCLK_GPIO: Peripheral Clock Selection for GPIOs
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.4..5> PCLK_PCB: Peripheral Clock Selection for the Pin Connect Block
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.6..7> PCLK_I2C1: Peripheral Clock Selection for I2C1
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.10..11> PCLK_SSP0: Peripheral Clock Selection for SSP0
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.12..13> PCLK_TIMER2: Peripheral Clock Selection for TIMER2
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.14..15> PCLK_TIMER3: Peripheral Clock Selection for TIMER3
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.16..17> PCLK_UART2: Peripheral Clock Selection for UART2
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.18..19> PCLK_UART3: Peripheral Clock Selection for UART3
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.20..21> PCLK_I2C2: Peripheral Clock Selection for I2C2
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.22..23> PCLK_I2S: Peripheral Clock Selection for I2S
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.26..27> PCLK_RIT: Peripheral Clock Selection for the Repetitive Interrupt Timer
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.28..29> PCLK_SYSCON: Peripheral Clock Selection for the System Control Block
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// <o10.30..31> PCLK_MC: Peripheral Clock Selection for the Motor Control PWM
|
||||
// <0=> Pclk = Cclk / 4
|
||||
// <1=> Pclk = Cclk
|
||||
// <2=> Pclk = Cclk / 2
|
||||
// <3=> Pclk = Hclk / 8
|
||||
// </h>
|
||||
//
|
||||
// <h> Power Control for Peripherals Register (PCONP)
|
||||
// <o11.1> PCTIM0: Timer/Counter 0 power/clock enable
|
||||
// <o11.2> PCTIM1: Timer/Counter 1 power/clock enable
|
||||
// <o11.3> PCUART0: UART 0 power/clock enable
|
||||
// <o11.4> PCUART1: UART 1 power/clock enable
|
||||
// <o11.6> PCPWM1: PWM 1 power/clock enable
|
||||
// <o11.7> PCI2C0: I2C interface 0 power/clock enable
|
||||
// <o11.8> PCSPI: SPI interface power/clock enable
|
||||
// <o11.9> PCRTC: RTC power/clock enable
|
||||
// <o11.10> PCSSP1: SSP interface 1 power/clock enable
|
||||
// <o11.12> PCAD: A/D converter power/clock enable
|
||||
// <o11.13> PCCAN1: CAN controller 1 power/clock enable
|
||||
// <o11.14> PCCAN2: CAN controller 2 power/clock enable
|
||||
// <o11.15> PCGPIO: GPIOs power/clock enable
|
||||
// <o11.16> PCRIT: Repetitive interrupt timer power/clock enable
|
||||
// <o11.17> PCMC: Motor control PWM power/clock enable
|
||||
// <o11.18> PCQEI: Quadrature encoder interface power/clock enable
|
||||
// <o11.19> PCI2C1: I2C interface 1 power/clock enable
|
||||
// <o11.21> PCSSP0: SSP interface 0 power/clock enable
|
||||
// <o11.22> PCTIM2: Timer 2 power/clock enable
|
||||
// <o11.23> PCTIM3: Timer 3 power/clock enable
|
||||
// <o11.24> PCUART2: UART 2 power/clock enable
|
||||
// <o11.25> PCUART3: UART 3 power/clock enable
|
||||
// <o11.26> PCI2C2: I2C interface 2 power/clock enable
|
||||
// <o11.27> PCI2S: I2S interface power/clock enable
|
||||
// <o11.29> PCGPDMA: GP DMA function power/clock enable
|
||||
// <o11.30> PCENET: Ethernet block power/clock enable
|
||||
// <o11.31> PCUSB: USB interface power/clock enable
|
||||
// </h>
|
||||
//
|
||||
// <h> Clock Output Configuration Register (CLKOUTCFG)
|
||||
// <o12.0..3> CLKOUTSEL: Selects clock source for CLKOUT
|
||||
// <0=> CPU clock
|
||||
// <1=> Main oscillator
|
||||
// <2=> Internal RC oscillator
|
||||
// <3=> USB clock
|
||||
// <4=> RTC oscillator
|
||||
// <o12.4..7> CLKOUTDIV: Selects clock divider for CLKOUT
|
||||
// <1-16><#-1>
|
||||
// <o12.8> CLKOUT_EN: CLKOUT enable control
|
||||
// </h>
|
||||
//
|
||||
// </e>
|
||||
*/
|
||||
|
||||
|
||||
|
||||
/** @addtogroup LPC17xx_System_Defines LPC17xx System Defines
|
||||
@{
|
||||
*/
|
||||
|
||||
#define CLOCK_SETUP 1
|
||||
#define SCS_Val 0x00000020
|
||||
#define CLKSRCSEL_Val 0x00000001
|
||||
#define PLL0_SETUP 1
|
||||
|
||||
#ifdef MCB1700
|
||||
# define PLL0CFG_Val 0x00050063
|
||||
# define PLL1_SETUP 1
|
||||
# define PLL1CFG_Val 0x00000023
|
||||
# define CCLKCFG_Val 0x00000003
|
||||
# define USBCLKCFG_Val 0x00000000
|
||||
#else
|
||||
# define PLL0CFG_Val 0x0000000B
|
||||
# define PLL1_SETUP 0
|
||||
# define PLL1CFG_Val 0x00000000
|
||||
# define CCLKCFG_Val 0x00000002
|
||||
# define USBCLKCFG_Val 0x00000005
|
||||
#endif
|
||||
|
||||
#define PCLKSEL0_Val 0x00000000
|
||||
#define PCLKSEL1_Val 0x00000000
|
||||
#define PCONP_Val 0x042887DE
|
||||
#define CLKOUTCFG_Val 0x00000000
|
||||
|
||||
|
||||
/*--------------------- Flash Accelerator Configuration ----------------------
|
||||
//
|
||||
// <e> Flash Accelerator Configuration
|
||||
// <o1.12..15> FLASHTIM: Flash Access Time
|
||||
// <0=> 1 CPU clock (for CPU clock up to 20 MHz)
|
||||
// <1=> 2 CPU clocks (for CPU clock up to 40 MHz)
|
||||
// <2=> 3 CPU clocks (for CPU clock up to 60 MHz)
|
||||
// <3=> 4 CPU clocks (for CPU clock up to 80 MHz)
|
||||
// <4=> 5 CPU clocks (for CPU clock up to 100 MHz)
|
||||
// <5=> 6 CPU clocks (for any CPU clock)
|
||||
// </e>
|
||||
*/
|
||||
#define FLASH_SETUP 1
|
||||
#define FLASHCFG_Val 0x0000303A
|
||||
|
||||
/*
|
||||
//-------- <<< end of configuration section >>> ------------------------------
|
||||
*/
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
Check the register settings
|
||||
*----------------------------------------------------------------------------*/
|
||||
#define CHECK_RANGE(val, min, max) ((val < min) || (val > max))
|
||||
#define CHECK_RSVD(val, mask) (val & mask)
|
||||
|
||||
/* Clock Configuration -------------------------------------------------------*/
|
||||
#if (CHECK_RSVD((SCS_Val), ~0x00000030))
|
||||
#error "SCS: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RANGE((CLKSRCSEL_Val), 0, 2))
|
||||
#error "CLKSRCSEL: Value out of range!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((PLL0CFG_Val), ~0x00FF7FFF))
|
||||
#error "PLL0CFG: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((PLL1CFG_Val), ~0x0000007F))
|
||||
#error "PLL1CFG: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (PLL0_SETUP) /* if PLL0 is used */
|
||||
#if (CCLKCFG_Val < 2) /* CCLKSEL must be greater then 1 */
|
||||
#error "CCLKCFG: CCLKSEL must be greater then 1 if PLL0 is used!"
|
||||
#endif
|
||||
#endif
|
||||
|
||||
#if (CHECK_RANGE((CCLKCFG_Val), 2, 255))
|
||||
#error "CCLKCFG: Value out of range!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((USBCLKCFG_Val), ~0x0000000F))
|
||||
#error "USBCLKCFG: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((PCLKSEL0_Val), 0x000C0C00))
|
||||
#error "PCLKSEL0: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((PCLKSEL1_Val), 0x03000300))
|
||||
#error "PCLKSEL1: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((PCONP_Val), 0x10100821))
|
||||
#error "PCONP: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
#if (CHECK_RSVD((CLKOUTCFG_Val), ~0x000001FF))
|
||||
#error "CLKOUTCFG: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
/* Flash Accelerator Configuration -------------------------------------------*/
|
||||
#if (CHECK_RSVD((FLASHCFG_Val), ~0x0000F07F))
|
||||
#error "FLASHCFG: Invalid values of reserved bits!"
|
||||
#endif
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
DEFINES
|
||||
*----------------------------------------------------------------------------*/
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
Define clocks
|
||||
*----------------------------------------------------------------------------*/
|
||||
#define XTAL (12000000UL) /* Oscillator frequency */
|
||||
#define OSC_CLK ( XTAL) /* Main oscillator frequency */
|
||||
#define RTC_CLK ( 32000UL) /* RTC oscillator frequency */
|
||||
#define IRC_OSC ( 4000000UL) /* Internal RC oscillator frequency */
|
||||
|
||||
|
||||
/* F_cco0 = (2 * M * F_in) / N */
|
||||
#define __M (((PLL0CFG_Val ) & 0x7FFF) + 1)
|
||||
#define __N (((PLL0CFG_Val >> 16) & 0x00FF) + 1)
|
||||
#define __FCCO(__F_IN) ((2ULL * __M * __F_IN) / __N)
|
||||
#define __CCLK_DIV (((CCLKCFG_Val ) & 0x00FF) + 1)
|
||||
|
||||
/* Determine core clock frequency according to settings */
|
||||
#if (PLL0_SETUP)
|
||||
#if ((CLKSRCSEL_Val & 0x03) == 1)
|
||||
#define __CORE_CLK (__FCCO(OSC_CLK) / __CCLK_DIV)
|
||||
#elif ((CLKSRCSEL_Val & 0x03) == 2)
|
||||
#define __CORE_CLK (__FCCO(RTC_CLK) / __CCLK_DIV)
|
||||
#else
|
||||
#define __CORE_CLK (__FCCO(IRC_OSC) / __CCLK_DIV)
|
||||
#endif
|
||||
#else
|
||||
#if ((CLKSRCSEL_Val & 0x03) == 1)
|
||||
#define __CORE_CLK (OSC_CLK / __CCLK_DIV)
|
||||
#elif ((CLKSRCSEL_Val & 0x03) == 2)
|
||||
#define __CORE_CLK (RTC_CLK / __CCLK_DIV)
|
||||
#else
|
||||
#define __CORE_CLK (IRC_OSC / __CCLK_DIV)
|
||||
#endif
|
||||
#endif
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
|
||||
/** @addtogroup LPC17xx_System_Public_Variables LPC17xx System Public Variables
|
||||
@{
|
||||
*/
|
||||
/*----------------------------------------------------------------------------
|
||||
Clock Variable definitions
|
||||
*----------------------------------------------------------------------------*/
|
||||
uint32_t SystemCoreClock = __CORE_CLK;/*!< System Clock Frequency (Core Clock)*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
|
||||
/** @addtogroup LPC17xx_System_Public_Functions LPC17xx System Public Functions
|
||||
@{
|
||||
*/
|
||||
|
||||
/**
|
||||
* Update SystemCoreClock variable
|
||||
*
|
||||
* @param none
|
||||
* @return none
|
||||
*
|
||||
* @brief Updates the SystemCoreClock with current core Clock
|
||||
* retrieved from cpu registers.
|
||||
*/void SystemCoreClockUpdate (void) /* Get Core Clock Frequency */
|
||||
{
|
||||
/* Determine clock frequency according to clock register values */
|
||||
if (((LPC_SC->PLL0STAT >> 24) & 3) == 3) { /* If PLL0 enabled and connected */
|
||||
switch (LPC_SC->CLKSRCSEL & 0x03) {
|
||||
case 0: /* Int. RC oscillator => PLL0 */
|
||||
case 3: /* Reserved, default to Int. RC */
|
||||
SystemCoreClock = (IRC_OSC *
|
||||
((2ULL * ((LPC_SC->PLL0STAT & 0x7FFF) + 1))) /
|
||||
(((LPC_SC->PLL0STAT >> 16) & 0xFF) + 1) /
|
||||
((LPC_SC->CCLKCFG & 0xFF)+ 1));
|
||||
break;
|
||||
case 1: /* Main oscillator => PLL0 */
|
||||
SystemCoreClock = (OSC_CLK *
|
||||
((2ULL * ((LPC_SC->PLL0STAT & 0x7FFF) + 1))) /
|
||||
(((LPC_SC->PLL0STAT >> 16) & 0xFF) + 1) /
|
||||
((LPC_SC->CCLKCFG & 0xFF)+ 1));
|
||||
break;
|
||||
case 2: /* RTC oscillator => PLL0 */
|
||||
SystemCoreClock = (RTC_CLK *
|
||||
((2ULL * ((LPC_SC->PLL0STAT & 0x7FFF) + 1))) /
|
||||
(((LPC_SC->PLL0STAT >> 16) & 0xFF) + 1) /
|
||||
((LPC_SC->CCLKCFG & 0xFF)+ 1));
|
||||
break;
|
||||
}
|
||||
} else {
|
||||
switch (LPC_SC->CLKSRCSEL & 0x03) {
|
||||
case 0: /* Int. RC oscillator => PLL0 */
|
||||
case 3: /* Reserved, default to Int. RC */
|
||||
SystemCoreClock = IRC_OSC / ((LPC_SC->CCLKCFG & 0xFF)+ 1);
|
||||
break;
|
||||
case 1: /* Main oscillator => PLL0 */
|
||||
SystemCoreClock = OSC_CLK / ((LPC_SC->CCLKCFG & 0xFF)+ 1);
|
||||
break;
|
||||
case 2: /* RTC oscillator => PLL0 */
|
||||
SystemCoreClock = RTC_CLK / ((LPC_SC->CCLKCFG & 0xFF)+ 1);
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
/**
|
||||
* Initialize the system
|
||||
*
|
||||
* @param none
|
||||
* @return none
|
||||
*
|
||||
* @brief Setup the microcontroller system.
|
||||
* Initialize the System.
|
||||
*/
|
||||
void SystemInit (void)
|
||||
{
|
||||
#if (CLOCK_SETUP) /* Clock Setup */
|
||||
LPC_SC->SCS = SCS_Val;
|
||||
if (LPC_SC->SCS & (1 << 5)) { /* If Main Oscillator is enabled */
|
||||
while ((LPC_SC->SCS & (1<<6)) == 0);/* Wait for Oscillator to be ready */
|
||||
}
|
||||
|
||||
LPC_SC->CCLKCFG = CCLKCFG_Val; /* Setup Clock Divider */
|
||||
/* Periphral clock must be selected before PLL0 enabling and connecting
|
||||
* - according errata.lpc1768-16.March.2010 -
|
||||
*/
|
||||
LPC_SC->PCLKSEL0 = PCLKSEL0_Val; /* Peripheral Clock Selection */
|
||||
LPC_SC->PCLKSEL1 = PCLKSEL1_Val;
|
||||
|
||||
#if (PLL0_SETUP)
|
||||
LPC_SC->CLKSRCSEL = CLKSRCSEL_Val; /* Select Clock Source for PLL0 */
|
||||
|
||||
LPC_SC->PLL0CFG = PLL0CFG_Val; /* configure PLL0 */
|
||||
LPC_SC->PLL0FEED = 0xAA;
|
||||
LPC_SC->PLL0FEED = 0x55;
|
||||
|
||||
LPC_SC->PLL0CON = 0x01; /* PLL0 Enable */
|
||||
LPC_SC->PLL0FEED = 0xAA;
|
||||
LPC_SC->PLL0FEED = 0x55;
|
||||
while (!(LPC_SC->PLL0STAT & (1<<26)));/* Wait for PLOCK0 */
|
||||
|
||||
LPC_SC->PLL0CON = 0x03; /* PLL0 Enable & Connect */
|
||||
LPC_SC->PLL0FEED = 0xAA;
|
||||
LPC_SC->PLL0FEED = 0x55;
|
||||
while (!(LPC_SC->PLL0STAT & ((1<<25) | (1<<24))));/* Wait for PLLC0_STAT & PLLE0_STAT */
|
||||
#endif
|
||||
|
||||
#if (PLL1_SETUP)
|
||||
LPC_SC->PLL1CFG = PLL1CFG_Val;
|
||||
LPC_SC->PLL1FEED = 0xAA;
|
||||
LPC_SC->PLL1FEED = 0x55;
|
||||
|
||||
LPC_SC->PLL1CON = 0x01; /* PLL1 Enable */
|
||||
LPC_SC->PLL1FEED = 0xAA;
|
||||
LPC_SC->PLL1FEED = 0x55;
|
||||
while (!(LPC_SC->PLL1STAT & (1<<10)));/* Wait for PLOCK1 */
|
||||
|
||||
LPC_SC->PLL1CON = 0x03; /* PLL1 Enable & Connect */
|
||||
LPC_SC->PLL1FEED = 0xAA;
|
||||
LPC_SC->PLL1FEED = 0x55;
|
||||
while (!(LPC_SC->PLL1STAT & ((1<< 9) | (1<< 8))));/* Wait for PLLC1_STAT & PLLE1_STAT */
|
||||
#else
|
||||
LPC_SC->USBCLKCFG = USBCLKCFG_Val; /* Setup USB Clock Divider */
|
||||
#endif
|
||||
|
||||
LPC_SC->PCONP = PCONP_Val; /* Power Control for Peripherals */
|
||||
|
||||
LPC_SC->CLKOUTCFG = CLKOUTCFG_Val; /* Clock Output Configuration */
|
||||
#endif
|
||||
|
||||
#if (FLASH_SETUP == 1) /* Flash Accelerator Setup */
|
||||
LPC_SC->FLASHCFG = (LPC_SC->FLASHCFG & ~0x0000F000) | FLASHCFG_Val;
|
||||
#endif
|
||||
}
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
||||
|
||||
/**
|
||||
* @}
|
||||
*/
|
|
@ -14,9 +14,9 @@ if __name__ == "__main__":
|
|||
"--specs=nano.specs",
|
||||
"--specs=nosys.specs",
|
||||
|
||||
"-IMarlin/src/HAL/HAL_LPC1768/framework_cmsis/CMSIS/Include",
|
||||
"-IMarlin/src/HAL/HAL_LPC1768/framework_cmsis/Device/NXP/LPC17xx/Include",
|
||||
"-IMarlin/src/HAL/HAL_LPC1768/framework_cmsis/Device/NXP/LPC17xx/drivers/include",
|
||||
"-IMarlin/frameworks/CMSIS/LPC1768/include",
|
||||
"-IMarlin/frameworks/CMSIS/LPC1768/lib",
|
||||
"-IMarlin/src/HAL",
|
||||
|
||||
"-MMD",
|
||||
"-MP",
|
||||
|
@ -46,6 +46,6 @@ else:
|
|||
"--specs=nano.specs",
|
||||
"--specs=nosys.specs",
|
||||
"-u_printf_float",
|
||||
"-Wl,-TMarlin/src/HAL/HAL_LPC1768/framework_cmsis/Device/NXP/LPC17xx/Source/Re-ARM/LPC1768.ld,--gc-sections"
|
||||
"-Wl,-TMarlin/frameworks/CMSIS/LPC1768/Re-ARM/LPC1768.ld,--gc-sections"
|
||||
],
|
||||
)
|
||||
|
|
|
@ -10,18 +10,18 @@ extern "C" {
|
|||
#include <lpc17xx_gpio.h>
|
||||
}
|
||||
|
||||
#include "usb/usb.h"
|
||||
#include "usb/usbcfg.h"
|
||||
#include "usb/usbhw.h"
|
||||
#include "usb/usbcore.h"
|
||||
#include "usb/cdc.h"
|
||||
#include "usb/cdcuser.h"
|
||||
#include "usb/mscuser.h"
|
||||
#include <usb/usb.h>
|
||||
#include <usb/usbcfg.h>
|
||||
#include <usb/usbhw.h>
|
||||
#include <usb/usbcore.h>
|
||||
#include <usb/cdc.h>
|
||||
#include <usb/cdcuser.h>
|
||||
#include <usb/mscuser.h>
|
||||
|
||||
extern "C" {
|
||||
#include <debug_frmwrk.h>
|
||||
#include "chanfs/diskio.h"
|
||||
#include "chanfs/ff.h"
|
||||
#include <chanfs/diskio.h>
|
||||
#include <chanfs/ff.h>
|
||||
}
|
||||
|
||||
#include "fastio.h"
|
||||
|
|
|
@ -1,3 +1,4 @@
|
|||
#ifdef TARGET_LPC1768
|
||||
#include "../persistent_store_api.h"
|
||||
|
||||
#include "../../../types.h"
|
||||
|
@ -8,7 +9,7 @@
|
|||
#include "chanfs/diskio.h"
|
||||
#include "chanfs/ff.h"
|
||||
|
||||
#ifdef TARGET_LPC1768
|
||||
|
||||
#if ENABLED(EEPROM_SETTINGS)
|
||||
|
||||
namespace HAL {
|
||||
|
|
|
@ -1,36 +0,0 @@
|
|||
[Version]
|
||||
Signature="$Windows NT$"
|
||||
Class=Ports
|
||||
ClassGuid={4D36E978-E325-11CE-BFC1-08002BE10318}
|
||||
Provider=%PROVIDER%
|
||||
DriverVer =04/14/2008, 5.1.2600.5512
|
||||
|
||||
[Manufacturer]
|
||||
%PROVIDER%=DeviceList,ntamd64
|
||||
|
||||
|
||||
[DeviceList]
|
||||
%DESCRIPTION%=LPC1768USB, USB\VID_1D50&PID_6029&MI_00
|
||||
|
||||
[DeviceList.ntamd64]
|
||||
%DESCRIPTION%=LPC1768USB, USB\VID_1D50&PID_6029&MI_00
|
||||
|
||||
|
||||
[LPC1768USB]
|
||||
include=mdmcpq.inf
|
||||
CopyFiles=FakeModemCopyFileSection
|
||||
AddReg=LowerFilterAddReg,SerialPropPageAddReg
|
||||
|
||||
[LPC1768USB.Services]
|
||||
include=mdmcpq.inf
|
||||
AddService=usbser, 0x00000002, LowerFilter_Service_Inst
|
||||
|
||||
[SerialPropPageAddReg]
|
||||
HKR,,EnumPropPages32,,"MsPorts.dll,SerialPortPropPageProvider"
|
||||
|
||||
|
||||
[Strings]
|
||||
PROVIDER = "marlinfw.org"
|
||||
DRIVER.SVC = "Marlin USB Driver"
|
||||
DESCRIPTION= "Marlin USB Serial"
|
||||
COMPOSITE = "Marlin USB VCOM"
|
|
@ -1,254 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: CDC.h
|
||||
* Purpose: USB Communication Device Class Definitions
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __CDC_H
|
||||
#define __CDC_H
|
||||
|
||||
extern "C" {
|
||||
#include <lpc_types.h>
|
||||
}
|
||||
|
||||
#if defined ( __GNUC__ )
|
||||
#define __packed __attribute__((__packed__))
|
||||
#endif
|
||||
/*----------------------------------------------------------------------------
|
||||
* Definitions based on usbcdc11.pdf (www.usb.org)
|
||||
*---------------------------------------------------------------------------*/
|
||||
// Communication device class specification version 1.10
|
||||
#define CDC_V1_10 0x0110
|
||||
|
||||
// Communication interface class code
|
||||
// (usbcdc11.pdf, 4.2, Table 15)
|
||||
#define CDC_COMMUNICATION_INTERFACE_CLASS 0x02
|
||||
|
||||
// Communication interface class subclass codes
|
||||
// (usbcdc11.pdf, 4.3, Table 16)
|
||||
#define CDC_DIRECT_LINE_CONTROL_MODEL 0x01
|
||||
#define CDC_ABSTRACT_CONTROL_MODEL 0x02
|
||||
#define CDC_TELEPHONE_CONTROL_MODEL 0x03
|
||||
#define CDC_MULTI_CHANNEL_CONTROL_MODEL 0x04
|
||||
#define CDC_CAPI_CONTROL_MODEL 0x05
|
||||
#define CDC_ETHERNET_NETWORKING_CONTROL_MODEL 0x06
|
||||
#define CDC_ATM_NETWORKING_CONTROL_MODEL 0x07
|
||||
|
||||
// Communication interface class control protocol codes
|
||||
// (usbcdc11.pdf, 4.4, Table 17)
|
||||
#define CDC_PROTOCOL_COMMON_AT_COMMANDS 0x01
|
||||
|
||||
// Data interface class code
|
||||
// (usbcdc11.pdf, 4.5, Table 18)
|
||||
#define CDC_DATA_INTERFACE_CLASS 0x0A
|
||||
|
||||
// Data interface class protocol codes
|
||||
// (usbcdc11.pdf, 4.7, Table 19)
|
||||
#define CDC_PROTOCOL_ISDN_BRI 0x30
|
||||
#define CDC_PROTOCOL_HDLC 0x31
|
||||
#define CDC_PROTOCOL_TRANSPARENT 0x32
|
||||
#define CDC_PROTOCOL_Q921_MANAGEMENT 0x50
|
||||
#define CDC_PROTOCOL_Q921_DATA_LINK 0x51
|
||||
#define CDC_PROTOCOL_Q921_MULTIPLEXOR 0x52
|
||||
#define CDC_PROTOCOL_V42 0x90
|
||||
#define CDC_PROTOCOL_EURO_ISDN 0x91
|
||||
#define CDC_PROTOCOL_V24_RATE_ADAPTATION 0x92
|
||||
#define CDC_PROTOCOL_CAPI 0x93
|
||||
#define CDC_PROTOCOL_HOST_BASED_DRIVER 0xFD
|
||||
#define CDC_PROTOCOL_DESCRIBED_IN_PUFD 0xFE
|
||||
|
||||
// Type values for bDescriptorType field of functional descriptors
|
||||
// (usbcdc11.pdf, 5.2.3, Table 24)
|
||||
#define CDC_CS_INTERFACE 0x24
|
||||
#define CDC_CS_ENDPOINT 0x25
|
||||
|
||||
// Type values for bDescriptorSubtype field of functional descriptors
|
||||
// (usbcdc11.pdf, 5.2.3, Table 25)
|
||||
#define CDC_HEADER 0x00
|
||||
#define CDC_CALL_MANAGEMENT 0x01
|
||||
#define CDC_ABSTRACT_CONTROL_MANAGEMENT 0x02
|
||||
#define CDC_DIRECT_LINE_MANAGEMENT 0x03
|
||||
#define CDC_TELEPHONE_RINGER 0x04
|
||||
#define CDC_REPORTING_CAPABILITIES 0x05
|
||||
#define CDC_UNION 0x06
|
||||
#define CDC_COUNTRY_SELECTION 0x07
|
||||
#define CDC_TELEPHONE_OPERATIONAL_MODES 0x08
|
||||
#define CDC_USB_TERMINAL 0x09
|
||||
#define CDC_NETWORK_CHANNEL 0x0A
|
||||
#define CDC_PROTOCOL_UNIT 0x0B
|
||||
#define CDC_EXTENSION_UNIT 0x0C
|
||||
#define CDC_MULTI_CHANNEL_MANAGEMENT 0x0D
|
||||
#define CDC_CAPI_CONTROL_MANAGEMENT 0x0E
|
||||
#define CDC_ETHERNET_NETWORKING 0x0F
|
||||
#define CDC_ATM_NETWORKING 0x10
|
||||
|
||||
// CDC class-specific request codes
|
||||
// (usbcdc11.pdf, 6.2, Table 46)
|
||||
// see Table 45 for info about the specific requests.
|
||||
#define CDC_SEND_ENCAPSULATED_COMMAND 0x00
|
||||
#define CDC_GET_ENCAPSULATED_RESPONSE 0x01
|
||||
#define CDC_SET_COMM_FEATURE 0x02
|
||||
#define CDC_GET_COMM_FEATURE 0x03
|
||||
#define CDC_CLEAR_COMM_FEATURE 0x04
|
||||
#define CDC_SET_AUX_LINE_STATE 0x10
|
||||
#define CDC_SET_HOOK_STATE 0x11
|
||||
#define CDC_PULSE_SETUP 0x12
|
||||
#define CDC_SEND_PULSE 0x13
|
||||
#define CDC_SET_PULSE_TIME 0x14
|
||||
#define CDC_RING_AUX_JACK 0x15
|
||||
#define CDC_SET_LINE_CODING 0x20
|
||||
#define CDC_GET_LINE_CODING 0x21
|
||||
#define CDC_SET_CONTROL_LINE_STATE 0x22
|
||||
#define CDC_SEND_BREAK 0x23
|
||||
#define CDC_SET_RINGER_PARMS 0x30
|
||||
#define CDC_GET_RINGER_PARMS 0x31
|
||||
#define CDC_SET_OPERATION_PARMS 0x32
|
||||
#define CDC_GET_OPERATION_PARMS 0x33
|
||||
#define CDC_SET_LINE_PARMS 0x34
|
||||
#define CDC_GET_LINE_PARMS 0x35
|
||||
#define CDC_DIAL_DIGITS 0x36
|
||||
#define CDC_SET_UNIT_PARAMETER 0x37
|
||||
#define CDC_GET_UNIT_PARAMETER 0x38
|
||||
#define CDC_CLEAR_UNIT_PARAMETER 0x39
|
||||
#define CDC_GET_PROFILE 0x3A
|
||||
#define CDC_SET_ETHERNET_MULTICAST_FILTERS 0x40
|
||||
#define CDC_SET_ETHERNET_PMP_FILTER 0x41
|
||||
#define CDC_GET_ETHERNET_PMP_FILTER 0x42
|
||||
#define CDC_SET_ETHERNET_PACKET_FILTER 0x43
|
||||
#define CDC_GET_ETHERNET_STATISTIC 0x44
|
||||
#define CDC_SET_ATM_DATA_FORMAT 0x50
|
||||
#define CDC_GET_ATM_DEVICE_STATISTICS 0x51
|
||||
#define CDC_SET_ATM_DEFAULT_VC 0x52
|
||||
#define CDC_GET_ATM_VC_STATISTICS 0x53
|
||||
|
||||
// Communication feature selector codes
|
||||
// (usbcdc11.pdf, 6.2.2..6.2.4, Table 47)
|
||||
#define CDC_ABSTRACT_STATE 0x01
|
||||
#define CDC_COUNTRY_SETTING 0x02
|
||||
|
||||
// Feature Status returned for ABSTRACT_STATE Selector
|
||||
// (usbcdc11.pdf, 6.2.3, Table 48)
|
||||
#define CDC_IDLE_SETTING (1 << 0)
|
||||
#define CDC_DATA_MULTPLEXED_STATE (1 << 1)
|
||||
|
||||
|
||||
// Control signal bitmap values for the SetControlLineState request
|
||||
// (usbcdc11.pdf, 6.2.14, Table 51)
|
||||
#define CDC_DTE_PRESENT (1 << 0)
|
||||
#define CDC_ACTIVATE_CARRIER (1 << 1)
|
||||
|
||||
// CDC class-specific notification codes
|
||||
// (usbcdc11.pdf, 6.3, Table 68)
|
||||
// see Table 67 for Info about class-specific notifications
|
||||
#define CDC_NOTIFICATION_NETWORK_CONNECTION 0x00
|
||||
#define CDC_RESPONSE_AVAILABLE 0x01
|
||||
#define CDC_AUX_JACK_HOOK_STATE 0x08
|
||||
#define CDC_RING_DETECT 0x09
|
||||
#define CDC_NOTIFICATION_SERIAL_STATE 0x20
|
||||
#define CDC_CALL_STATE_CHANGE 0x28
|
||||
#define CDC_LINE_STATE_CHANGE 0x29
|
||||
#define CDC_CONNECTION_SPEED_CHANGE 0x2A
|
||||
|
||||
// UART state bitmap values (Serial state notification).
|
||||
// (usbcdc11.pdf, 6.3.5, Table 69)
|
||||
#define CDC_SERIAL_STATE_OVERRUN (1 << 6) // receive data overrun error has occurred
|
||||
#define CDC_SERIAL_STATE_PARITY (1 << 5) // parity error has occurred
|
||||
#define CDC_SERIAL_STATE_FRAMING (1 << 4) // framing error has occurred
|
||||
#define CDC_SERIAL_STATE_RING (1 << 3) // state of ring signal detection
|
||||
#define CDC_SERIAL_STATE_BREAK (1 << 2) // state of break detection
|
||||
#define CDC_SERIAL_STATE_TX_CARRIER (1 << 1) // state of transmission carrier
|
||||
#define CDC_SERIAL_STATE_RX_CARRIER (1 << 0) // state of receiver carrier
|
||||
|
||||
// capabilities callmgmt
|
||||
#define CDC_CALLMGMT_CAP_CALLMGMT 0x01
|
||||
#define CDC_CALLMGMT_CAP_DATAINTF 0x02
|
||||
|
||||
// capabilities acm
|
||||
#define CDC_ACM_CAP_COMM 0x01
|
||||
#define CDC_ACM_CAP_LINE 0x02
|
||||
#define CDC_ACM_CAP_BRK 0x04
|
||||
#define CDC_ACM_CAP_NOTIFY 0x08
|
||||
|
||||
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
* Structures based on usbcdc11.pdf (www.usb.org)
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
// Header functional descriptor
|
||||
// (usbcdc11.pdf, 5.2.3.1)
|
||||
// This header must precede any list of class-specific descriptors.
|
||||
typedef struct __packed _CDC_HEADER_DESCRIPTOR{
|
||||
uint8_t bFunctionLength; // size of this descriptor in bytes
|
||||
uint8_t bDescriptorType; // CS_INTERFACE descriptor type
|
||||
uint8_t bDescriptorSubtype; // Header functional descriptor subtype
|
||||
uint16_t bcdCDC; // USB CDC specification release version
|
||||
} CDC_HEADER_DESCRIPTOR;
|
||||
|
||||
//Call management functional descriptor
|
||||
// (usbcdc11.pdf, 5.2.3.2)
|
||||
// Describes the processing of calls for the communication class interface.
|
||||
typedef struct __packed _CDC_CALL_MANAGEMENT_DESCRIPTOR{
|
||||
uint8_t bFunctionLength; // size of this descriptor in bytes
|
||||
uint8_t bDescriptorType; // CS_INTERFACE descriptor type
|
||||
uint8_t bDescriptorSubtype; // call management functional descriptor subtype
|
||||
uint8_t bmCapabilities; // capabilities that this configuration supports
|
||||
uint8_t bDataInterface; // interface number of the data class interface used for call management (optional)
|
||||
} CDC_CALL_MANAGEMENT_DESCRIPTOR;
|
||||
|
||||
// Abstract control management functional descriptor
|
||||
// (usbcdc11.pdf, 5.2.3.3)
|
||||
// Describes the command supported by the communication interface class with the Abstract Control Model subclass code.
|
||||
typedef struct __packed _CDC_ABSTRACT_CONTROL_MANAGEMENT_DESCRIPTOR{
|
||||
uint8_t bFunctionLength; // size of this descriptor in bytes
|
||||
uint8_t bDescriptorType; // CS_INTERFACE descriptor type
|
||||
uint8_t bDescriptorSubtype; // abstract control management functional descriptor subtype
|
||||
uint8_t bmCapabilities; // capabilities supported by this configuration
|
||||
} CDC_ABSTRACT_CONTROL_MANAGEMENT_DESCRIPTOR;
|
||||
|
||||
// Union functional descriptors
|
||||
// (usbcdc11.pdf, 5.2.3.8)
|
||||
// Describes the relationship between a group of interfaces that can be considered to form a functional unit.
|
||||
typedef struct __packed _CDC_UNION_DESCRIPTOR{
|
||||
uint8_t bFunctionLength; // size of this descriptor in bytes
|
||||
uint8_t bDescriptorType; // CS_INTERFACE descriptor type
|
||||
uint8_t bDescriptorSubtype; // union functional descriptor subtype
|
||||
uint8_t bMasterInterface; // interface number designated as master
|
||||
} CDC_UNION_DESCRIPTOR;
|
||||
|
||||
// Union functional descriptors with one slave interface
|
||||
// (usbcdc11.pdf, 5.2.3.8)
|
||||
typedef struct __packed _CDC_UNION_1SLAVE_DESCRIPTOR{
|
||||
CDC_UNION_DESCRIPTOR sUnion; // Union functional descriptor
|
||||
uint8_t bSlaveInterfaces[1]; // Slave interface 0
|
||||
} CDC_UNION_1SLAVE_DESCRIPTOR;
|
||||
|
||||
// Line coding structure
|
||||
// Format of the data returned when a GetLineCoding request is received
|
||||
// (usbcdc11.pdf, 6.2.13)
|
||||
typedef struct __packed _CDC_LINE_CODING{
|
||||
uint32_t dwDTERate; // Data terminal rate in bits per second
|
||||
uint8_t bCharFormat; // Number of stop bits
|
||||
uint8_t bParityType; // Parity bit type
|
||||
uint8_t bDataBits; // Number of data bits
|
||||
} CDC_LINE_CODING;
|
||||
|
||||
// Notification header
|
||||
// Data sent on the notification endpoint must follow this header.
|
||||
// see USB_SETUP_PACKET in file usb.h
|
||||
typedef USB_SETUP_PACKET CDC_NOTIFICATION_HEADER;
|
||||
|
||||
#endif /* __CDC_H */
|
||||
|
|
@ -1,258 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: cdcuser.c
|
||||
* Purpose: USB Communication Device Class User module
|
||||
* Version: V1.10
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC microcontroller devices only. Nothing else
|
||||
* gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
extern "C" {
|
||||
#include <lpc_types.h>
|
||||
#include <debug_frmwrk.h>
|
||||
}
|
||||
|
||||
#include "usb.h"
|
||||
#include "usbhw.h"
|
||||
#include "usbcfg.h"
|
||||
#include "usbcore.h"
|
||||
#include "cdc.h"
|
||||
#include "cdcuser.h"
|
||||
|
||||
#include "../serial.h"
|
||||
|
||||
unsigned char BulkBufIn[USB_CDC_BUFSIZE]; // Buffer to store USB IN packet
|
||||
unsigned char BulkBufOut[USB_CDC_BUFSIZE]; // Buffer to store USB OUT packet
|
||||
unsigned char NotificationBuf[10];
|
||||
|
||||
CDC_LINE_CODING CDC_LineCoding = { 921600, 0, 0, 8 };
|
||||
unsigned short CDC_DepInEmpty = 1; // Data IN EP is empty
|
||||
unsigned short CDC_LineState = 0;
|
||||
unsigned short CDC_SerialState = 0;
|
||||
|
||||
|
||||
extern HalSerial usb_serial;
|
||||
/*----------------------------------------------------------------------------
|
||||
write data to CDC_OutBuf
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_WrOutBuf(const char *buffer, uint32_t *length) {
|
||||
uint32_t bytesToWrite, bytesWritten;
|
||||
|
||||
// Write *length bytes
|
||||
bytesToWrite = *length;
|
||||
bytesWritten = bytesToWrite;
|
||||
|
||||
while (bytesToWrite) {
|
||||
usb_serial.receive_buffer.write(*buffer++); // Copy Data to buffer
|
||||
bytesToWrite--;
|
||||
}
|
||||
|
||||
return (bytesWritten);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
check if character(s) are available at CDC_OutBuf
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_OutBufAvailChar(uint32_t *availChar) {
|
||||
*availChar = usb_serial.transmit_buffer.available();
|
||||
return (0);
|
||||
}
|
||||
/* end Buffer handling */
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC Initialisation
|
||||
Initializes the data structures and serial port
|
||||
Parameters: None
|
||||
Return Value: None
|
||||
*---------------------------------------------------------------------------*/
|
||||
void CDC_Init() {
|
||||
CDC_DepInEmpty = 1;
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC SendEncapsulatedCommand Request Callback
|
||||
Called automatically on CDC SEND_ENCAPSULATED_COMMAND Request
|
||||
Parameters: None (global SetupPacket and EP0Buf)
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_SendEncapsulatedCommand(void) {
|
||||
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC GetEncapsulatedResponse Request Callback
|
||||
Called automatically on CDC Get_ENCAPSULATED_RESPONSE Request
|
||||
Parameters: None (global SetupPacket and EP0Buf)
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_GetEncapsulatedResponse(void) {
|
||||
|
||||
/* ... add code to handle request */
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC SetCommFeature Request Callback
|
||||
Called automatically on CDC Set_COMM_FATURE Request
|
||||
Parameters: FeatureSelector
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_SetCommFeature(unsigned short wFeatureSelector) {
|
||||
|
||||
/* ... add code to handle request */
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC GetCommFeature Request Callback
|
||||
Called automatically on CDC Get_COMM_FATURE Request
|
||||
Parameters: FeatureSelector
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_GetCommFeature(unsigned short wFeatureSelector) {
|
||||
|
||||
/* ... add code to handle request */
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC ClearCommFeature Request Callback
|
||||
Called automatically on CDC CLEAR_COMM_FATURE Request
|
||||
Parameters: FeatureSelector
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_ClearCommFeature(unsigned short wFeatureSelector) {
|
||||
|
||||
/* ... add code to handle request */
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC SetLineCoding Request Callback
|
||||
Called automatically on CDC SET_LINE_CODING Request
|
||||
Parameters: none (global SetupPacket and EP0Buf)
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_SetLineCoding(void) {
|
||||
|
||||
CDC_LineCoding.dwDTERate = (EP0Buf[0] << 0) | (EP0Buf[1] << 8) | (EP0Buf[2] << 16) | (EP0Buf[3] << 24);
|
||||
CDC_LineCoding.bCharFormat = EP0Buf[4];
|
||||
CDC_LineCoding.bParityType = EP0Buf[5];
|
||||
CDC_LineCoding.bDataBits = EP0Buf[6];
|
||||
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC GetLineCoding Request Callback
|
||||
Called automatically on CDC GET_LINE_CODING Request
|
||||
Parameters: None (global SetupPacket and EP0Buf)
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_GetLineCoding(void) {
|
||||
|
||||
EP0Buf[0] = (CDC_LineCoding.dwDTERate >> 0) & 0xFF;
|
||||
EP0Buf[1] = (CDC_LineCoding.dwDTERate >> 8) & 0xFF;
|
||||
EP0Buf[2] = (CDC_LineCoding.dwDTERate >> 16) & 0xFF;
|
||||
EP0Buf[3] = (CDC_LineCoding.dwDTERate >> 24) & 0xFF;
|
||||
EP0Buf[4] = CDC_LineCoding.bCharFormat;
|
||||
EP0Buf[5] = CDC_LineCoding.bParityType;
|
||||
EP0Buf[6] = CDC_LineCoding.bDataBits;
|
||||
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC SetControlLineState Request Callback
|
||||
Called automatically on CDC SET_CONTROL_LINE_STATE Request
|
||||
Parameters: ControlSignalBitmap
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_SetControlLineState(unsigned short wControlSignalBitmap) {
|
||||
CDC_LineState = wControlSignalBitmap;
|
||||
usb_serial.host_connected = wControlSignalBitmap > 0 ? true : false;
|
||||
return true;
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC SendBreak Request Callback
|
||||
Called automatically on CDC Set_COMM_FATURE Request
|
||||
Parameters: 0xFFFF start of Break
|
||||
0x0000 stop of Break
|
||||
0x#### Duration of Break
|
||||
Return Value: TRUE - Success, FALSE - Error
|
||||
*---------------------------------------------------------------------------*/
|
||||
uint32_t CDC_SendBreak(unsigned short wDurationOfBreak) {
|
||||
|
||||
/* ... add code to handle request */
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC_BulkIn call on DataIn Request
|
||||
Parameters: none
|
||||
Return Value: none
|
||||
*---------------------------------------------------------------------------*/
|
||||
void CDC_BulkIn(void) {
|
||||
uint32_t numBytesAvail = usb_serial.transmit_buffer.available();
|
||||
|
||||
if (numBytesAvail > 0) {
|
||||
numBytesAvail = numBytesAvail > (USB_CDC_BUFSIZE - 1) ? (USB_CDC_BUFSIZE - 1) : numBytesAvail;
|
||||
for(uint32_t i = 0; i < numBytesAvail; ++i) {
|
||||
BulkBufIn[i] = usb_serial.transmit_buffer.read(); //todo: optimise
|
||||
}
|
||||
USB_WriteEP(CDC_DEP_IN, &BulkBufIn[0], numBytesAvail);
|
||||
} else {
|
||||
CDC_DepInEmpty = 1;
|
||||
}
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
CDC_BulkOut call on DataOut Request
|
||||
Parameters: none
|
||||
Return Value: none
|
||||
*---------------------------------------------------------------------------*/
|
||||
void CDC_BulkOut(void) {
|
||||
uint32_t numBytesRead = USB_ReadEP(CDC_DEP_OUT, &BulkBufOut[0]);
|
||||
CDC_WrOutBuf((char *) &BulkBufOut[0], &numBytesRead);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
Get the SERIAL_STATE as defined in usbcdc11.pdf, 6.3.5, Table 69.
|
||||
Parameters: none
|
||||
Return Value: SerialState as defined in usbcdc11.pdf
|
||||
*---------------------------------------------------------------------------*/
|
||||
unsigned short CDC_GetSerialState(void) {
|
||||
CDC_SerialState = CDC_LineState;
|
||||
//todo: detect buffer overrun
|
||||
return (CDC_SerialState);
|
||||
}
|
||||
|
||||
/*----------------------------------------------------------------------------
|
||||
Send the SERIAL_STATE notification as defined in usbcdc11.pdf, 6.3.5.
|
||||
*---------------------------------------------------------------------------*/
|
||||
void CDC_NotificationIn(void) {
|
||||
|
||||
NotificationBuf[0] = 0xA1; // bmRequestType
|
||||
NotificationBuf[1] = CDC_NOTIFICATION_SERIAL_STATE; // bNotification (SERIAL_STATE)
|
||||
NotificationBuf[2] = 0x00; // wValue
|
||||
NotificationBuf[3] = 0x00;
|
||||
NotificationBuf[4] = 0x00; // wIndex (Interface #, LSB first)
|
||||
NotificationBuf[5] = 0x00;
|
||||
NotificationBuf[6] = 0x02; // wLength (Data length = 2 bytes, LSB first)
|
||||
NotificationBuf[7] = 0x00;
|
||||
NotificationBuf[8] = (CDC_SerialState >> 0) & 0xFF; // UART State Bitmap (16bits, LSB first)
|
||||
NotificationBuf[9] = (CDC_SerialState >> 8) & 0xFF;
|
||||
|
||||
USB_WriteEP(CDC_CEP_IN, &NotificationBuf[0], 10); // send notification
|
||||
}
|
|
@ -1,62 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: cdcuser.h
|
||||
* Purpose: USB Communication Device Class User module Definitions
|
||||
* Version: V1.10
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC microcontroller devices only. Nothing else
|
||||
* gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __CDCUSER_H__
|
||||
#define __CDCUSER_H__
|
||||
|
||||
/* CDC buffer handling */
|
||||
extern uint32_t CDC_RdOutBuf(char *buffer, const uint32_t *length);
|
||||
extern uint32_t CDC_WrOutBuf(const char *buffer, uint32_t *length);
|
||||
extern uint32_t CDC_OutBufAvailChar(uint32_t *availChar);
|
||||
|
||||
/* CDC Data In/Out Endpoint Address */
|
||||
#define CDC_DEP_IN 0x82
|
||||
#define CDC_DEP_OUT 0x02
|
||||
|
||||
/* CDC Communication In Endpoint Address */
|
||||
#define CDC_CEP_IN 0x81
|
||||
|
||||
/* CDC Requests Callback Functions */
|
||||
extern uint32_t CDC_SendEncapsulatedCommand(void);
|
||||
extern uint32_t CDC_GetEncapsulatedResponse(void);
|
||||
extern uint32_t CDC_SetCommFeature(unsigned short wFeatureSelector);
|
||||
extern uint32_t CDC_GetCommFeature(unsigned short wFeatureSelector);
|
||||
extern uint32_t CDC_ClearCommFeature(unsigned short wFeatureSelector);
|
||||
extern uint32_t CDC_GetLineCoding(void);
|
||||
extern uint32_t CDC_SetLineCoding(void);
|
||||
extern uint32_t CDC_SetControlLineState(unsigned short wControlSignalBitmap);
|
||||
extern uint32_t CDC_SendBreak(unsigned short wDurationOfBreak);
|
||||
|
||||
/* CDC Bulk Callback Functions */
|
||||
extern void CDC_BulkIn(void);
|
||||
extern void CDC_BulkOut(void);
|
||||
|
||||
/* CDC Notification Callback Function */
|
||||
extern void CDC_NotificationIn(void);
|
||||
|
||||
/* CDC Initializtion Function */
|
||||
extern void CDC_Init();
|
||||
|
||||
/* CDC prepare the SERAIAL_STATE */
|
||||
extern unsigned short CDC_GetSerialState(void);
|
||||
|
||||
/* flow control */
|
||||
extern unsigned short CDC_DepInEmpty; // DataEndPoint IN empty
|
||||
|
||||
#endif /* __CDCUSER_H__ */
|
||||
|
|
@ -1,116 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: MSC.H
|
||||
* Purpose: USB Mass Storage Class Definitions
|
||||
* Version: V1.10
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2005-2009 Keil Software.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __MSC_H__
|
||||
#define __MSC_H__
|
||||
|
||||
|
||||
#if defined ( __GNUC__ )
|
||||
#define __packed __attribute__((__packed__))
|
||||
#endif
|
||||
|
||||
|
||||
/* MSC Subclass Codes */
|
||||
#define MSC_SUBCLASS_RBC 0x01
|
||||
#define MSC_SUBCLASS_SFF8020I_MMC2 0x02
|
||||
#define MSC_SUBCLASS_QIC157 0x03
|
||||
#define MSC_SUBCLASS_UFI 0x04
|
||||
#define MSC_SUBCLASS_SFF8070I 0x05
|
||||
#define MSC_SUBCLASS_SCSI 0x06
|
||||
|
||||
/* MSC Protocol Codes */
|
||||
#define MSC_PROTOCOL_CBI_INT 0x00
|
||||
#define MSC_PROTOCOL_CBI_NOINT 0x01
|
||||
#define MSC_PROTOCOL_BULK_ONLY 0x50
|
||||
|
||||
|
||||
/* MSC Request Codes */
|
||||
#define MSC_REQUEST_RESET 0xFF
|
||||
#define MSC_REQUEST_GET_MAX_LUN 0xFE
|
||||
|
||||
|
||||
/* MSC Bulk-only Stage */
|
||||
#define MSC_BS_CBW 0 /* Command Block Wrapper */
|
||||
#define MSC_BS_DATA_OUT 1 /* Data Out Phase */
|
||||
#define MSC_BS_DATA_IN 2 /* Data In Phase */
|
||||
#define MSC_BS_DATA_IN_LAST 3 /* Data In Last Phase */
|
||||
#define MSC_BS_DATA_IN_LAST_STALL 4 /* Data In Last Phase with Stall */
|
||||
#define MSC_BS_CSW 5 /* Command Status Wrapper */
|
||||
#define MSC_BS_ERROR 6 /* Error */
|
||||
|
||||
|
||||
/* Bulk-only Command Block Wrapper */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _MSC_CBW {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _MSC_CBW {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
typedef __packed struct _MSC_CBW {
|
||||
#endif
|
||||
uint32_t dSignature;
|
||||
uint32_t dTag;
|
||||
uint32_t dDataLength;
|
||||
uint8_t bmFlags;
|
||||
uint8_t bLUN;
|
||||
uint8_t bCBLength;
|
||||
uint8_t CB[16];
|
||||
} MSC_CBW;
|
||||
|
||||
/* Bulk-only Command Status Wrapper */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _MSC_CSW {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _MSC_CSW {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
typedef __packed struct _MSC_CSW {
|
||||
#endif
|
||||
uint32_t dSignature;
|
||||
uint32_t dTag;
|
||||
uint32_t dDataResidue;
|
||||
uint8_t bStatus;
|
||||
} MSC_CSW;
|
||||
|
||||
#define MSC_CBW_Signature 0x43425355
|
||||
#define MSC_CSW_Signature 0x53425355
|
||||
|
||||
|
||||
/* CSW Status Definitions */
|
||||
#define CSW_CMD_PASSED 0x00
|
||||
#define CSW_CMD_FAILED 0x01
|
||||
#define CSW_PHASE_ERROR 0x02
|
||||
|
||||
|
||||
/* SCSI Commands */
|
||||
#define SCSI_TEST_UNIT_READY 0x00
|
||||
#define SCSI_REQUEST_SENSE 0x03
|
||||
#define SCSI_FORMAT_UNIT 0x04
|
||||
#define SCSI_INQUIRY 0x12
|
||||
#define SCSI_MODE_SELECT6 0x15
|
||||
#define SCSI_MODE_SENSE6 0x1A
|
||||
#define SCSI_START_STOP_UNIT 0x1B
|
||||
#define SCSI_MEDIA_REMOVAL 0x1E
|
||||
#define SCSI_READ_FORMAT_CAPACITIES 0x23
|
||||
#define SCSI_READ_CAPACITY 0x25
|
||||
#define SCSI_READ10 0x28
|
||||
#define SCSI_WRITE10 0x2A
|
||||
#define SCSI_VERIFY10 0x2F
|
||||
#define SCSI_MODE_SELECT10 0x55
|
||||
#define SCSI_MODE_SENSE10 0x5A
|
||||
|
||||
|
||||
#endif /* __MSC_H__ */
|
|
@ -1,716 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: MSCUSER.C
|
||||
* Purpose: Mass Storage Class Custom User Module
|
||||
* Version: V1.10
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2005-2009 Keil Software.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
extern "C" {
|
||||
#include "LPC17xx.h"
|
||||
#include "lpc_types.h"
|
||||
}
|
||||
#include "usb.h"
|
||||
#include "msc.h"
|
||||
#include "usbcfg.h"
|
||||
#include "usbhw.h"
|
||||
#include "usbcore.h"
|
||||
#include "mscuser.h"
|
||||
|
||||
#include "../chanfs/diskio.h"
|
||||
#include <debug_frmwrk.h>
|
||||
|
||||
DWORD MSC_BlockCount = 0;
|
||||
|
||||
uint32_t MemOK; /* Memory OK */
|
||||
|
||||
DWORD lba; /* start block */
|
||||
DWORD transfer_count; /* blocks to transfer */
|
||||
DWORD length;
|
||||
uint32_t block_offset; /* current block offset*/
|
||||
|
||||
uint8_t BulkStage; /* Bulk Stage */
|
||||
|
||||
uint8_t BulkBuf[MSC_MAX_PACKET]; /* Bulk In/Out Buffer */
|
||||
uint8_t block_cache[MSC_BLOCK_SIZE];
|
||||
uint8_t BulkLen; /* Bulk In/Out Length */
|
||||
|
||||
MSC_CBW CBW; /* Command Block Wrapper */
|
||||
MSC_CSW CSW; /* Command Status Wrapper */
|
||||
uint8_t media_lock = 0;
|
||||
|
||||
uint32_t MSC_SD_Lock() {
|
||||
media_lock = CBW.CB[4]; //0x1 - lock, 0x0 - unlock
|
||||
// logical_unit = CBW.CB[1] & 0xE0;
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
MSC_SetCSW();
|
||||
return 0;
|
||||
}
|
||||
|
||||
uint32_t MSC_SD_Release(uint8_t pdrv) {
|
||||
MSC_BlockCount = 0;
|
||||
return 0;
|
||||
}
|
||||
|
||||
uint32_t MSC_SD_Init(uint8_t pdrv) {
|
||||
DSTATUS ret = disk_initialize(pdrv);
|
||||
if(ret) return ret;
|
||||
if(disk_ioctl (pdrv, GET_SECTOR_COUNT, (void *)(&MSC_BlockCount))) return 1;
|
||||
return 0;
|
||||
}
|
||||
|
||||
#define STARTSTOP_STOPMOTOR 0x0
|
||||
#define STARTSTOP_STARTMOTOR 0x1
|
||||
#define STARTSTOP_EJECT 0x2
|
||||
#define STARTSTOP_LOAD 0x3
|
||||
|
||||
void MSC_StartStopUnit() {
|
||||
switch (CBW.CB[4] & 0x03) {
|
||||
case STARTSTOP_EJECT:
|
||||
MSC_SD_Release(0);
|
||||
break;
|
||||
case STARTSTOP_LOAD:
|
||||
if(MSC_BlockCount == 0) {
|
||||
if(MSC_SD_Init(0) != 0) {
|
||||
CSW.bStatus = CSW_CMD_FAILED;
|
||||
MSC_SetCSW();
|
||||
return;
|
||||
}
|
||||
}
|
||||
break;
|
||||
default:
|
||||
_DBG("MSC_StartStopUnit unknown startstopunit sub command\n");
|
||||
}
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
MSC_SetCSW();
|
||||
}
|
||||
|
||||
/*
|
||||
* MSC Mass Storage Reset Request Callback
|
||||
* Called automatically on Mass Storage Reset Request
|
||||
* Parameters: None (global SetupPacket and EP0Buf)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
uint32_t MSC_Reset (void) {
|
||||
BulkStage = MSC_BS_CBW;
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Get Max LUN Request Callback
|
||||
* Called automatically on Get Max LUN Request
|
||||
* Parameters: None (global SetupPacket and EP0Buf)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
uint32_t MSC_GetMaxLUN (void) {
|
||||
|
||||
EP0Buf[0] = 0; /* No LUN associated with this device */
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Memory Read Callback
|
||||
* Called automatically on Memory Read Event
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_MemoryRead (void) {
|
||||
uint32_t n = (length > MSC_MAX_PACKET) ? MSC_MAX_PACKET : length;
|
||||
|
||||
if (lba > MSC_BlockCount) {
|
||||
n = (MSC_BlockCount - lba) * MSC_BLOCK_SIZE + block_offset;
|
||||
BulkStage = MSC_BS_ERROR;
|
||||
}
|
||||
|
||||
if(block_offset == 0) {
|
||||
disk_read (0, block_cache, lba, 1);
|
||||
}
|
||||
|
||||
USB_WriteEP(MSC_EP_IN, &block_cache[block_offset], n);
|
||||
|
||||
block_offset += n;
|
||||
length -= n;
|
||||
CSW.dDataResidue -= n;
|
||||
|
||||
if(block_offset >= MSC_BLOCK_SIZE) {
|
||||
block_offset = 0;
|
||||
++lba;
|
||||
}
|
||||
|
||||
if (length == 0) {
|
||||
BulkStage = MSC_BS_DATA_IN_LAST;
|
||||
}
|
||||
|
||||
if (BulkStage != MSC_BS_DATA_IN) {
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Memory Write Callback
|
||||
* Called automatically on Memory Write Event
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_MemoryWrite (void) {
|
||||
|
||||
for (uint32_t n = 0; n < BulkLen; n++) {
|
||||
block_cache[block_offset + n] = BulkBuf[n];
|
||||
}
|
||||
|
||||
if(block_offset + BulkLen >= MSC_BLOCK_SIZE) {
|
||||
if(!(disk_status(0) & STA_PROTECT)){
|
||||
disk_write(0, block_cache, lba, 1);
|
||||
}
|
||||
}
|
||||
|
||||
block_offset += BulkLen;
|
||||
length -= BulkLen;
|
||||
CSW.dDataResidue -= BulkLen;
|
||||
|
||||
if(block_offset >= MSC_BLOCK_SIZE) {
|
||||
block_offset = 0;
|
||||
++lba;
|
||||
}
|
||||
|
||||
if ((length == 0) || (BulkStage == MSC_BS_CSW)) {
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
MSC_SetCSW();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Memory Verify Callback
|
||||
* Called automatically on Memory Verify Event
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_MemoryVerify (void) {
|
||||
|
||||
if(!block_offset) {
|
||||
disk_read(0, block_cache, lba, 1);
|
||||
}
|
||||
|
||||
for (uint32_t n = 0; n < BulkLen; n++) {
|
||||
if (block_cache[block_offset + n] != BulkBuf[n]) {
|
||||
MemOK = FALSE;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
block_offset += BulkLen;
|
||||
length -= BulkLen;
|
||||
CSW.dDataResidue -= BulkLen;
|
||||
|
||||
if ((length == 0) || (BulkStage == MSC_BS_CSW)) {
|
||||
CSW.bStatus = (MemOK) ? CSW_CMD_PASSED : CSW_CMD_FAILED;
|
||||
MSC_SetCSW();
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Read/Write Setup Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
uint32_t MSC_RWSetup (void) {
|
||||
uint32_t n;
|
||||
|
||||
/* Logical Block Address of First Block */
|
||||
lba = (CBW.CB[2] << 24) |
|
||||
(CBW.CB[3] << 16) |
|
||||
(CBW.CB[4] << 8) |
|
||||
(CBW.CB[5] << 0);
|
||||
|
||||
/* Number of Blocks to transfer */
|
||||
transfer_count = (CBW.CB[7] << 8) |
|
||||
(CBW.CB[8] << 0);
|
||||
|
||||
block_offset = 0;
|
||||
length = transfer_count * MSC_BLOCK_SIZE;
|
||||
|
||||
if (CBW.dDataLength != (transfer_count * MSC_BLOCK_SIZE)) {
|
||||
USB_SetStallEP(MSC_EP_IN);
|
||||
USB_SetStallEP(MSC_EP_OUT);
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
return (FALSE);
|
||||
}
|
||||
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Check Data IN Format
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
uint32_t DataInFormat (void) {
|
||||
|
||||
if (CBW.dDataLength == 0) {
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
return (FALSE);
|
||||
}
|
||||
if ((CBW.bmFlags & 0x80) == 0) {
|
||||
USB_SetStallEP(MSC_EP_OUT);
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Perform Data IN Transfer
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
void DataInTransfer (void) {
|
||||
|
||||
if (BulkLen > CBW.dDataLength) {
|
||||
BulkLen = CBW.dDataLength;
|
||||
}
|
||||
|
||||
USB_WriteEP(MSC_EP_IN, BulkBuf, BulkLen);
|
||||
BulkStage = MSC_BS_DATA_IN_LAST;
|
||||
|
||||
CSW.dDataResidue -= BulkLen;
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Test Unit Ready Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_TestUnitReady (void) {
|
||||
|
||||
if (CBW.dDataLength != 0) {
|
||||
if ((CBW.bmFlags & 0x80) != 0) {
|
||||
USB_SetStallEP(MSC_EP_IN);
|
||||
} else {
|
||||
USB_SetStallEP(MSC_EP_OUT);
|
||||
}
|
||||
}
|
||||
|
||||
if(MSC_BlockCount > 0) {
|
||||
CSW.bStatus = CSW_CMD_PASSED;
|
||||
} else {
|
||||
CSW.bStatus = CSW_CMD_FAILED;
|
||||
}
|
||||
|
||||
MSC_SetCSW();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Request Sense Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_RequestSense (void) {
|
||||
|
||||
if (!DataInFormat()) return;
|
||||
|
||||
BulkBuf[ 0] = 0x70; /* Response Code */
|
||||
BulkBuf[ 1] = 0x00;
|
||||
BulkBuf[ 2] = static_cast<uint8_t>(Sense_KEY::ILLEGAL_REQUEST);
|
||||
BulkBuf[ 3] = 0x00;
|
||||
BulkBuf[ 4] = 0x00;
|
||||
BulkBuf[ 5] = 0x00;
|
||||
BulkBuf[ 6] = 0x00;
|
||||
BulkBuf[ 7] = 0x0A; /* Additional Length */
|
||||
|
||||
BulkBuf[ 8] = 0x00;
|
||||
BulkBuf[ 9] = 0x00;
|
||||
BulkBuf[10] = 0x00;
|
||||
BulkBuf[11] = 0x00;
|
||||
BulkBuf[12] = static_cast<uint8_t>(Sense_ASC::CANNOT_READ_MEDIUM);
|
||||
BulkBuf[13] = static_cast<uint8_t>(Sense_ASCQ::UNKNOWN_FORMAT);
|
||||
BulkBuf[14] = 0x00;
|
||||
BulkBuf[15] = 0x00;
|
||||
BulkBuf[16] = 0x00;
|
||||
BulkBuf[17] = 0x00;
|
||||
|
||||
if (MSC_BlockCount == 0) {
|
||||
BulkBuf[ 2] = static_cast<uint8_t>(Sense_KEY::NOT_READY);
|
||||
BulkBuf[12] = static_cast<uint8_t>(Sense_ASC::MEDIUM_NOT_PRESENT);
|
||||
BulkBuf[13] = static_cast<uint8_t>(Sense_ASCQ::LOADABLE);
|
||||
}
|
||||
|
||||
BulkLen = 18;
|
||||
DataInTransfer();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Inquiry Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_Inquiry (void) {
|
||||
|
||||
if (!DataInFormat()) return;
|
||||
|
||||
BulkBuf[ 0] = 0x00; /* Direct Access Device */
|
||||
BulkBuf[ 1] = 0x80; /* RMB = 1: Removable Medium */
|
||||
BulkBuf[ 2] = 0x00; /* Version: No conformance claim to standard */
|
||||
BulkBuf[ 3] = 0x01;
|
||||
|
||||
BulkBuf[ 4] = 36-4; /* Additional Length */
|
||||
BulkBuf[ 5] = 0x80; /* SCCS = 1: Storage Controller Component */
|
||||
BulkBuf[ 6] = 0x00;
|
||||
BulkBuf[ 7] = 0x00;
|
||||
|
||||
BulkBuf[ 8] = 'M'; /* Vendor Identification */
|
||||
BulkBuf[ 9] = 'a';
|
||||
BulkBuf[10] = 'r';
|
||||
BulkBuf[11] = 'l';
|
||||
BulkBuf[12] = 'i';
|
||||
BulkBuf[13] = 'n';
|
||||
BulkBuf[14] = ' ';
|
||||
BulkBuf[15] = ' ';
|
||||
|
||||
BulkBuf[16] = 'R'; /* Product Identification */
|
||||
BulkBuf[17] = 'e';
|
||||
BulkBuf[18] = '-';
|
||||
BulkBuf[19] = 'A';
|
||||
BulkBuf[20] = 'R';
|
||||
BulkBuf[21] = 'M';
|
||||
BulkBuf[22] = ' ';
|
||||
BulkBuf[23] = 'S';
|
||||
BulkBuf[24] = 'D';
|
||||
BulkBuf[25] = 'C';
|
||||
BulkBuf[26] = 'a';
|
||||
BulkBuf[27] = 'r';
|
||||
BulkBuf[28] = 'd';
|
||||
BulkBuf[29] = ' ';
|
||||
BulkBuf[30] = '0';
|
||||
BulkBuf[31] = '1';
|
||||
|
||||
BulkBuf[32] = '1'; /* Product Revision Level */
|
||||
BulkBuf[33] = '.';
|
||||
BulkBuf[34] = '0';
|
||||
BulkBuf[35] = ' ';
|
||||
|
||||
if(MSC_BlockCount == 0) {
|
||||
BulkBuf[0] = 0x20; // Direct Access Device usually available but not currently
|
||||
}
|
||||
|
||||
BulkLen = 36;
|
||||
DataInTransfer();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Mode Sense (6-Byte) Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_ModeSense6 (void) {
|
||||
|
||||
if (!DataInFormat()) return;
|
||||
|
||||
BulkBuf[ 0] = 0x03;
|
||||
BulkBuf[ 1] = 0x00;
|
||||
BulkBuf[ 2] = 0x00;
|
||||
BulkBuf[ 3] = 0x00;
|
||||
|
||||
BulkLen = 4;
|
||||
DataInTransfer();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Mode Sense (10-Byte) Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_ModeSense10 (void) {
|
||||
|
||||
if (!DataInFormat()) return;
|
||||
|
||||
BulkBuf[ 0] = 0x00;
|
||||
BulkBuf[ 1] = 0x06;
|
||||
BulkBuf[ 2] = 0x00;
|
||||
BulkBuf[ 3] = 0x00;
|
||||
BulkBuf[ 4] = 0x00;
|
||||
BulkBuf[ 5] = 0x00;
|
||||
BulkBuf[ 6] = 0x00;
|
||||
BulkBuf[ 7] = 0x00;
|
||||
|
||||
BulkLen = 8;
|
||||
DataInTransfer();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Read Capacity Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_ReadCapacity (void) {
|
||||
|
||||
if (!DataInFormat()) return;
|
||||
|
||||
/* Last Logical Block */
|
||||
BulkBuf[ 0] = ((MSC_BlockCount - 1) >> 24) & 0xFF;
|
||||
BulkBuf[ 1] = ((MSC_BlockCount - 1) >> 16) & 0xFF;
|
||||
BulkBuf[ 2] = ((MSC_BlockCount - 1) >> 8) & 0xFF;
|
||||
BulkBuf[ 3] = ((MSC_BlockCount - 1) >> 0) & 0xFF;
|
||||
|
||||
/* Block Length */
|
||||
BulkBuf[ 4] = (MSC_BLOCK_SIZE >> 24) & 0xFF;
|
||||
BulkBuf[ 5] = (MSC_BLOCK_SIZE >> 16) & 0xFF;
|
||||
BulkBuf[ 6] = (MSC_BLOCK_SIZE >> 8) & 0xFF;
|
||||
BulkBuf[ 7] = (MSC_BLOCK_SIZE >> 0) & 0xFF;
|
||||
|
||||
BulkLen = 8;
|
||||
DataInTransfer();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC SCSI Read Format Capacity Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_ReadFormatCapacity (void) {
|
||||
|
||||
if (!DataInFormat()) return;
|
||||
|
||||
BulkBuf[ 0] = 0x00;
|
||||
BulkBuf[ 1] = 0x00;
|
||||
BulkBuf[ 2] = 0x00;
|
||||
BulkBuf[ 3] = 0x08; /* Capacity List Length */
|
||||
|
||||
/* Block Count */
|
||||
BulkBuf[ 4] = (MSC_BlockCount >> 24) & 0xFF;
|
||||
BulkBuf[ 5] = (MSC_BlockCount >> 16) & 0xFF;
|
||||
BulkBuf[ 6] = (MSC_BlockCount >> 8) & 0xFF;
|
||||
BulkBuf[ 7] = (MSC_BlockCount >> 0) & 0xFF;
|
||||
|
||||
/* Block Length */
|
||||
BulkBuf[ 8] = 0x02; /* Descriptor Code: Formatted Media */
|
||||
BulkBuf[ 9] = (MSC_BLOCK_SIZE >> 16) & 0xFF;
|
||||
BulkBuf[10] = (MSC_BLOCK_SIZE >> 8) & 0xFF;
|
||||
BulkBuf[11] = (MSC_BLOCK_SIZE >> 0) & 0xFF;
|
||||
|
||||
BulkLen = 12;
|
||||
DataInTransfer();
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Get Command Block Wrapper Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_GetCBW (void) {
|
||||
uint32_t n;
|
||||
|
||||
for (n = 0; n < BulkLen; n++) {
|
||||
*((uint8_t *)&CBW + n) = BulkBuf[n];
|
||||
}
|
||||
if ((BulkLen == sizeof(CBW)) && (CBW.dSignature == MSC_CBW_Signature)) {
|
||||
/* Valid CBW */
|
||||
CSW.dTag = CBW.dTag;
|
||||
CSW.dDataResidue = CBW.dDataLength;
|
||||
if ((CBW.bLUN != 0) || (CBW.bCBLength < 1) || CBW.bCBLength > 16) {
|
||||
fail: CSW.bStatus = CSW_CMD_FAILED;
|
||||
MSC_SetCSW();
|
||||
_DBG("Failed SCSI OP code ");
|
||||
_DBH(CBW.CB[0]);
|
||||
_DBG("\n");
|
||||
} else {
|
||||
switch (CBW.CB[0]) {
|
||||
case SCSI_TEST_UNIT_READY:
|
||||
MSC_TestUnitReady();
|
||||
break;
|
||||
case SCSI_REQUEST_SENSE:
|
||||
MSC_RequestSense();
|
||||
break;
|
||||
case SCSI_FORMAT_UNIT:
|
||||
goto fail;
|
||||
case SCSI_INQUIRY:
|
||||
MSC_Inquiry();
|
||||
break;
|
||||
case SCSI_START_STOP_UNIT:
|
||||
MSC_StartStopUnit();
|
||||
break;
|
||||
case SCSI_MEDIA_REMOVAL:
|
||||
MSC_SD_Lock();
|
||||
break;
|
||||
case SCSI_MODE_SELECT6:
|
||||
goto fail;
|
||||
case SCSI_MODE_SENSE6:
|
||||
MSC_ModeSense6();
|
||||
break;
|
||||
case SCSI_MODE_SELECT10:
|
||||
goto fail;
|
||||
case SCSI_MODE_SENSE10:
|
||||
MSC_ModeSense10();
|
||||
break;
|
||||
case SCSI_READ_FORMAT_CAPACITIES:
|
||||
MSC_ReadFormatCapacity();
|
||||
break;
|
||||
case SCSI_READ_CAPACITY:
|
||||
MSC_ReadCapacity();
|
||||
break;
|
||||
case SCSI_READ10:
|
||||
if (MSC_RWSetup()) {
|
||||
if ((CBW.bmFlags & 0x80) != 0) {
|
||||
BulkStage = MSC_BS_DATA_IN;
|
||||
MSC_MemoryRead();
|
||||
} else {
|
||||
USB_SetStallEP(MSC_EP_OUT);
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
}
|
||||
}
|
||||
break;
|
||||
case SCSI_WRITE10:
|
||||
if (MSC_RWSetup()) {
|
||||
if ((CBW.bmFlags & 0x80) == 0) {
|
||||
BulkStage = MSC_BS_DATA_OUT;
|
||||
} else {
|
||||
USB_SetStallEP(MSC_EP_IN);
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
}
|
||||
}
|
||||
break;
|
||||
case SCSI_VERIFY10:
|
||||
if (MSC_RWSetup()) {
|
||||
if ((CBW.bmFlags & 0x80) == 0) {
|
||||
BulkStage = MSC_BS_DATA_OUT;
|
||||
MemOK = TRUE;
|
||||
} else {
|
||||
USB_SetStallEP(MSC_EP_IN);
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
}
|
||||
}
|
||||
break;
|
||||
default:
|
||||
goto fail;
|
||||
}
|
||||
}
|
||||
} else {
|
||||
/* Invalid CBW */
|
||||
USB_SetStallEP(MSC_EP_IN);
|
||||
USB_SetStallEP(MSC_EP_OUT);
|
||||
BulkStage = MSC_BS_ERROR;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Set Command Status Wrapper Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_SetCSW (void) {
|
||||
|
||||
CSW.dSignature = MSC_CSW_Signature;
|
||||
USB_WriteEP(MSC_EP_IN, (uint8_t *)&CSW, sizeof(CSW));
|
||||
BulkStage = MSC_BS_CSW;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Bulk In Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_BulkIn (void) {
|
||||
|
||||
switch (BulkStage) {
|
||||
case MSC_BS_DATA_IN:
|
||||
switch (CBW.CB[0]) {
|
||||
case SCSI_READ10:
|
||||
MSC_MemoryRead();
|
||||
break;
|
||||
}
|
||||
break;
|
||||
case MSC_BS_DATA_IN_LAST:
|
||||
MSC_SetCSW();
|
||||
break;
|
||||
case MSC_BS_DATA_IN_LAST_STALL:
|
||||
USB_SetStallEP(MSC_EP_IN);
|
||||
MSC_SetCSW();
|
||||
break;
|
||||
case MSC_BS_CSW:
|
||||
BulkStage = MSC_BS_CBW;
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* MSC Bulk Out Callback
|
||||
* Parameters: None (global variables)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void MSC_BulkOut (void) {
|
||||
|
||||
BulkLen = (uint8_t)USB_ReadEP(MSC_EP_OUT, BulkBuf);
|
||||
switch (BulkStage) {
|
||||
case MSC_BS_CBW:
|
||||
MSC_GetCBW();
|
||||
break;
|
||||
case MSC_BS_DATA_OUT:
|
||||
switch (CBW.CB[0]) {
|
||||
case SCSI_WRITE10:
|
||||
MSC_MemoryWrite();
|
||||
break;
|
||||
case SCSI_VERIFY10:
|
||||
MSC_MemoryVerify();
|
||||
break;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
USB_SetStallEP(MSC_EP_OUT);
|
||||
CSW.bStatus = CSW_PHASE_ERROR;
|
||||
MSC_SetCSW();
|
||||
break;
|
||||
}
|
||||
}
|
|
@ -1,69 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: MSCUSER.H
|
||||
* Purpose: Mass Storage Class Custom User Definitions
|
||||
* Version: V1.10
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2005-2009 Keil Software.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __MSCUSER_H__
|
||||
#define __MSCUSER_H__
|
||||
|
||||
|
||||
/* Max In/Out Packet Size */
|
||||
#define MSC_MAX_PACKET 64
|
||||
#define MSC_BLOCK_SIZE 512
|
||||
|
||||
/* MSC In/Out Endpoint Address */
|
||||
#define MSC_EP_IN 0x85
|
||||
#define MSC_EP_OUT 0x05
|
||||
|
||||
/* MSC Requests Callback Functions */
|
||||
extern uint32_t MSC_Reset (void);
|
||||
extern uint32_t MSC_GetMaxLUN (void);
|
||||
|
||||
/* MSC Bulk Callback Functions */
|
||||
extern void MSC_GetCBW (void);
|
||||
extern void MSC_SetCSW (void);
|
||||
extern void MSC_BulkIn (void);
|
||||
extern void MSC_BulkOut(void);
|
||||
|
||||
enum class Sense_KEY : uint8_t {
|
||||
NO_SENSE,
|
||||
RECOVERED_ERROR,
|
||||
NOT_READY,
|
||||
MEDIUM_ERROR,
|
||||
HARDWARE_ERROR,
|
||||
ILLEGAL_REQUEST,
|
||||
UNIT_ATTENTION,
|
||||
DATA_PROTECT
|
||||
};
|
||||
|
||||
enum class Sense_ASC : uint8_t {
|
||||
CANNOT_READ_MEDIUM = 0x30,
|
||||
MEDIUM_NOT_PRESENT = 0x3A
|
||||
};
|
||||
|
||||
enum class Sense_ASCQ : uint8_t {
|
||||
// CANNOT_READ_MEDIUM
|
||||
UNKNOWN_FORMAT = 0x01,
|
||||
// MEDIUM_NOT_PRESENT
|
||||
REASON_UNKNOWN = 0x00,
|
||||
TRAY_CLOSED,
|
||||
TRAY_OPEN,
|
||||
LOADABLE,
|
||||
AUXILIARY_MEMORY_ACCESSIBLE
|
||||
};
|
||||
|
||||
|
||||
#endif /* __MSCUSER_H__ */
|
|
@ -1,353 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usb.h
|
||||
* Purpose: USB Definitions
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USB_H__
|
||||
#define __USB_H__
|
||||
extern "C" {
|
||||
#include "lpc_types.h"
|
||||
}
|
||||
#if defined ( __GNUC__ )
|
||||
#define __packed __attribute__((__packed__))
|
||||
#endif
|
||||
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed union {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef union __packed {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef union {
|
||||
#endif
|
||||
uint16_t W;
|
||||
#if defined ( __CC_ARM )
|
||||
__packed struct {
|
||||
#elif defined ( __GNUC__ )
|
||||
struct __packed {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
struct {
|
||||
#endif
|
||||
uint8_t L;
|
||||
uint8_t H;
|
||||
} WB;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
} WORD_BYTE;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
|
||||
/* bmRequestType.Dir */
|
||||
#define REQUEST_HOST_TO_DEVICE 0
|
||||
#define REQUEST_DEVICE_TO_HOST 1
|
||||
|
||||
/* bmRequestType.Type */
|
||||
#define REQUEST_STANDARD 0
|
||||
#define REQUEST_CLASS 1
|
||||
#define REQUEST_VENDOR 2
|
||||
#define REQUEST_RESERVED 3
|
||||
|
||||
/* bmRequestType.Recipient */
|
||||
#define REQUEST_TO_DEVICE 0
|
||||
#define REQUEST_TO_INTERFACE 1
|
||||
#define REQUEST_TO_ENDPOINT 2
|
||||
#define REQUEST_TO_OTHER 3
|
||||
|
||||
/* bmRequestType Definition */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed union _REQUEST_TYPE {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef union __packed _REQUEST_TYPE {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef union _REQUEST_TYPE {
|
||||
#endif
|
||||
#if defined ( __CC_ARM )
|
||||
__packed struct _BM {
|
||||
#elif defined ( __GNUC__ )
|
||||
struct __packed _BM {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
struct _BM {
|
||||
#endif
|
||||
uint8_t Recipient : 5;
|
||||
uint8_t Type : 2;
|
||||
uint8_t Dir : 1;
|
||||
} BM;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
uint8_t B;
|
||||
} REQUEST_TYPE;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
/* USB Standard Request Codes */
|
||||
#define USB_REQUEST_GET_STATUS 0
|
||||
#define USB_REQUEST_CLEAR_FEATURE 1
|
||||
#define USB_REQUEST_SET_FEATURE 3
|
||||
#define USB_REQUEST_SET_ADDRESS 5
|
||||
#define USB_REQUEST_GET_DESCRIPTOR 6
|
||||
#define USB_REQUEST_SET_DESCRIPTOR 7
|
||||
#define USB_REQUEST_GET_CONFIGURATION 8
|
||||
#define USB_REQUEST_SET_CONFIGURATION 9
|
||||
#define USB_REQUEST_GET_INTERFACE 10
|
||||
#define USB_REQUEST_SET_INTERFACE 11
|
||||
#define USB_REQUEST_SYNC_FRAME 12
|
||||
|
||||
/* USB GET_STATUS Bit Values */
|
||||
#define USB_GETSTATUS_SELF_POWERED 0x01
|
||||
#define USB_GETSTATUS_REMOTE_WAKEUP 0x02
|
||||
#define USB_GETSTATUS_ENDPOINT_STALL 0x01
|
||||
|
||||
/* USB Standard Feature selectors */
|
||||
#define USB_FEATURE_ENDPOINT_STALL 0
|
||||
#define USB_FEATURE_REMOTE_WAKEUP 1
|
||||
|
||||
/* USB Default Control Pipe Setup Packet */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_SETUP_PACKET {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_SETUP_PACKET {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_SETUP_PACKET {
|
||||
#endif
|
||||
REQUEST_TYPE bmRequestType;
|
||||
uint8_t bRequest;
|
||||
WORD_BYTE wValue;
|
||||
WORD_BYTE wIndex;
|
||||
uint16_t wLength;
|
||||
} USB_SETUP_PACKET;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
|
||||
/* USB Descriptor Types */
|
||||
#define USB_DEVICE_DESCRIPTOR_TYPE 1
|
||||
#define USB_CONFIGURATION_DESCRIPTOR_TYPE 2
|
||||
#define USB_STRING_DESCRIPTOR_TYPE 3
|
||||
#define USB_INTERFACE_DESCRIPTOR_TYPE 4
|
||||
#define USB_ENDPOINT_DESCRIPTOR_TYPE 5
|
||||
#define USB_DEVICE_QUALIFIER_DESCRIPTOR_TYPE 6
|
||||
#define USB_OTHER_SPEED_CONFIG_DESCRIPTOR_TYPE 7
|
||||
#define USB_INTERFACE_POWER_DESCRIPTOR_TYPE 8
|
||||
#define USB_OTG_DESCRIPTOR_TYPE 9
|
||||
#define USB_DEBUG_DESCRIPTOR_TYPE 10
|
||||
#define USB_INTERFACE_ASSOCIATION_DESCRIPTOR_TYPE 11
|
||||
|
||||
/* USB Device Classes */
|
||||
#define USB_DEVICE_CLASS_RESERVED 0x00
|
||||
#define USB_DEVICE_CLASS_AUDIO 0x01
|
||||
#define USB_DEVICE_CLASS_COMMUNICATIONS 0x02
|
||||
#define USB_DEVICE_CLASS_HUMAN_INTERFACE 0x03
|
||||
#define USB_DEVICE_CLASS_MONITOR 0x04
|
||||
#define USB_DEVICE_CLASS_PHYSICAL_INTERFACE 0x05
|
||||
#define USB_DEVICE_CLASS_POWER 0x06
|
||||
#define USB_DEVICE_CLASS_PRINTER 0x07
|
||||
#define USB_DEVICE_CLASS_STORAGE 0x08
|
||||
#define USB_DEVICE_CLASS_HUB 0x09
|
||||
#define USB_DEVICE_CLASS_MISCELLANEOUS 0xEF
|
||||
#define USB_DEVICE_CLASS_VENDOR_SPECIFIC 0xFF
|
||||
|
||||
/* bmAttributes in Configuration Descriptor */
|
||||
#define USB_CONFIG_POWERED_MASK 0x40
|
||||
#define USB_CONFIG_BUS_POWERED 0x80
|
||||
#define USB_CONFIG_SELF_POWERED 0xC0
|
||||
#define USB_CONFIG_REMOTE_WAKEUP 0x20
|
||||
|
||||
/* bMaxPower in Configuration Descriptor */
|
||||
#define USB_CONFIG_POWER_MA(mA) ((mA)/2)
|
||||
|
||||
/* bEndpointAddress in Endpoint Descriptor */
|
||||
#define USB_ENDPOINT_DIRECTION_MASK 0x80
|
||||
#define USB_ENDPOINT_OUT(addr) ((addr) | 0x00)
|
||||
#define USB_ENDPOINT_IN(addr) ((addr) | 0x80)
|
||||
|
||||
/* bmAttributes in Endpoint Descriptor */
|
||||
#define USB_ENDPOINT_TYPE_MASK 0x03
|
||||
#define USB_ENDPOINT_TYPE_CONTROL 0x00
|
||||
#define USB_ENDPOINT_TYPE_ISOCHRONOUS 0x01
|
||||
#define USB_ENDPOINT_TYPE_BULK 0x02
|
||||
#define USB_ENDPOINT_TYPE_INTERRUPT 0x03
|
||||
#define USB_ENDPOINT_SYNC_MASK 0x0C
|
||||
#define USB_ENDPOINT_SYNC_NO_SYNCHRONIZATION 0x00
|
||||
#define USB_ENDPOINT_SYNC_ASYNCHRONOUS 0x04
|
||||
#define USB_ENDPOINT_SYNC_ADAPTIVE 0x08
|
||||
#define USB_ENDPOINT_SYNC_SYNCHRONOUS 0x0C
|
||||
#define USB_ENDPOINT_USAGE_MASK 0x30
|
||||
#define USB_ENDPOINT_USAGE_DATA 0x00
|
||||
#define USB_ENDPOINT_USAGE_FEEDBACK 0x10
|
||||
#define USB_ENDPOINT_USAGE_IMPLICIT_FEEDBACK 0x20
|
||||
#define USB_ENDPOINT_USAGE_RESERVED 0x30
|
||||
|
||||
/* USB Standard Device Descriptor */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_DEVICE_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_DEVICE_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_DEVICE_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
uint16_t bcdUSB;
|
||||
uint8_t bDeviceClass;
|
||||
uint8_t bDeviceSubClass;
|
||||
uint8_t bDeviceProtocol;
|
||||
uint8_t bMaxPacketSize0;
|
||||
uint16_t idVendor;
|
||||
uint16_t idProduct;
|
||||
uint16_t bcdDevice;
|
||||
uint8_t iManufacturer;
|
||||
uint8_t iProduct;
|
||||
uint8_t iSerialNumber;
|
||||
uint8_t bNumConfigurations;
|
||||
} USB_DEVICE_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
/* USB 2.0 Device Qualifier Descriptor */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_DEVICE_QUALIFIER_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_DEVICE_QUALIFIER_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_DEVICE_QUALIFIER_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
uint16_t bcdUSB;
|
||||
uint8_t bDeviceClass;
|
||||
uint8_t bDeviceSubClass;
|
||||
uint8_t bDeviceProtocol;
|
||||
uint8_t bMaxPacketSize0;
|
||||
uint8_t bNumConfigurations;
|
||||
uint8_t bReserved;
|
||||
} USB_DEVICE_QUALIFIER_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_CONFIGURATION_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_CONFIGURATION_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_CONFIGURATION_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
uint16_t wTotalLength;
|
||||
uint8_t bNumInterfaces;
|
||||
uint8_t bConfigurationValue;
|
||||
uint8_t iConfiguration;
|
||||
uint8_t bmAttributes;
|
||||
uint8_t bMaxPower;
|
||||
} USB_CONFIGURATION_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
/* USB Standard Interface Descriptor */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_INTERFACE_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_INTERFACE_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_INTERFACE_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
uint8_t bInterfaceNumber;
|
||||
uint8_t bAlternateSetting;
|
||||
uint8_t bNumEndpoints;
|
||||
uint8_t bInterfaceClass;
|
||||
uint8_t bInterfaceSubClass;
|
||||
uint8_t bInterfaceProtocol;
|
||||
uint8_t iInterface;
|
||||
} USB_INTERFACE_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
/* USB Standard Endpoint Descriptor */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_ENDPOINT_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_ENDPOINT_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_ENDPOINT_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
uint8_t bEndpointAddress;
|
||||
uint8_t bmAttributes;
|
||||
uint16_t wMaxPacketSize;
|
||||
uint8_t bInterval;
|
||||
} USB_ENDPOINT_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
/* USB String Descriptor */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_STRING_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_STRING_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_STRING_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
uint16_t bString/*[]*/;
|
||||
} USB_STRING_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
/* USB Common Descriptor */
|
||||
#if defined ( __CC_ARM )
|
||||
typedef __packed struct _USB_COMMON_DESCRIPTOR {
|
||||
#elif defined ( __GNUC__ )
|
||||
typedef struct __packed _USB_COMMON_DESCRIPTOR {
|
||||
#elif defined ( __IAR_SYSTEMS_ICC__ )
|
||||
#pragma pack(1)
|
||||
typedef struct _USB_COMMON_DESCRIPTOR {
|
||||
#endif
|
||||
uint8_t bLength;
|
||||
uint8_t bDescriptorType;
|
||||
} USB_COMMON_DESCRIPTOR;
|
||||
#ifdef __IAR_SYSTEMS_ICC__
|
||||
#pragma pack()
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
#endif /* __USB_H__ */
|
|
@ -1,181 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbcfg.h
|
||||
* Purpose: USB Custom Configuration
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*----------------------------------------------------------------------------
|
||||
* History:
|
||||
* V1.20 Added vendor specific support
|
||||
* V1.00 Initial Version
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USBCFG_H__
|
||||
#define __USBCFG_H__
|
||||
|
||||
|
||||
//*** <<< Use Configuration Wizard in Context Menu >>> ***
|
||||
|
||||
|
||||
/*
|
||||
// <h> USB Configuration
|
||||
// <o0> USB Power
|
||||
// <i> Default Power Setting
|
||||
// <0=> Bus-powered
|
||||
// <1=> Self-powered
|
||||
// <o1> Max Number of Interfaces <1-256>
|
||||
// <o2> Max Number of Endpoints <1-32>
|
||||
// <o3> Max Endpoint 0 Packet Size
|
||||
// <8=> 8 Bytes <16=> 16 Bytes <32=> 32 Bytes <64=> 64 Bytes
|
||||
// <e4> DMA Transfer
|
||||
// <i> Use DMA for selected Endpoints
|
||||
// <o5.0> Endpoint 0 Out
|
||||
// <o5.1> Endpoint 0 In
|
||||
// <o5.2> Endpoint 1 Out
|
||||
// <o5.3> Endpoint 1 In
|
||||
// <o5.4> Endpoint 2 Out
|
||||
// <o5.5> Endpoint 2 In
|
||||
// <o5.6> Endpoint 3 Out
|
||||
// <o5.7> Endpoint 3 In
|
||||
// <o5.8> Endpoint 4 Out
|
||||
// <o5.9> Endpoint 4 In
|
||||
// <o5.10> Endpoint 5 Out
|
||||
// <o5.11> Endpoint 5 In
|
||||
// <o5.12> Endpoint 6 Out
|
||||
// <o5.13> Endpoint 6 In
|
||||
// <o5.14> Endpoint 7 Out
|
||||
// <o5.15> Endpoint 7 In
|
||||
// <o5.16> Endpoint 8 Out
|
||||
// <o5.17> Endpoint 8 In
|
||||
// <o5.18> Endpoint 9 Out
|
||||
// <o5.19> Endpoint 9 In
|
||||
// <o5.20> Endpoint 10 Out
|
||||
// <o5.21> Endpoint 10 In
|
||||
// <o5.22> Endpoint 11 Out
|
||||
// <o5.23> Endpoint 11 In
|
||||
// <o5.24> Endpoint 12 Out
|
||||
// <o5.25> Endpoint 12 In
|
||||
// <o5.26> Endpoint 13 Out
|
||||
// <o5.27> Endpoint 13 In
|
||||
// <o5.28> Endpoint 14 Out
|
||||
// <o5.29> Endpoint 14 In
|
||||
// <o5.30> Endpoint 15 Out
|
||||
// <o5.31> Endpoint 15 In
|
||||
// </e>
|
||||
// </h>
|
||||
*/
|
||||
|
||||
#define USB_POWER 0
|
||||
#define USB_IF_NUM 4
|
||||
#define USB_EP_NUM 32
|
||||
#define USB_MAX_PACKET0 64
|
||||
#define USB_DMA 0
|
||||
#define USB_DMA_EP 0x00000000
|
||||
|
||||
|
||||
/*
|
||||
// <h> USB Event Handlers
|
||||
// <h> Device Events
|
||||
// <o0.0> Power Event
|
||||
// <o1.0> Reset Event
|
||||
// <o2.0> Suspend Event
|
||||
// <o3.0> Resume Event
|
||||
// <o4.0> Remote Wakeup Event
|
||||
// <o5.0> Start of Frame Event
|
||||
// <o6.0> Error Event
|
||||
// </h>
|
||||
// <h> Endpoint Events
|
||||
// <o7.0> Endpoint 0 Event
|
||||
// <o7.1> Endpoint 1 Event
|
||||
// <o7.2> Endpoint 2 Event
|
||||
// <o7.3> Endpoint 3 Event
|
||||
// <o7.4> Endpoint 4 Event
|
||||
// <o7.5> Endpoint 5 Event
|
||||
// <o7.6> Endpoint 6 Event
|
||||
// <o7.7> Endpoint 7 Event
|
||||
// <o7.8> Endpoint 8 Event
|
||||
// <o7.9> Endpoint 9 Event
|
||||
// <o7.10> Endpoint 10 Event
|
||||
// <o7.11> Endpoint 11 Event
|
||||
// <o7.12> Endpoint 12 Event
|
||||
// <o7.13> Endpoint 13 Event
|
||||
// <o7.14> Endpoint 14 Event
|
||||
// <o7.15> Endpoint 15 Event
|
||||
// </h>
|
||||
// <h> USB Core Events
|
||||
// <o8.0> Set Configuration Event
|
||||
// <o9.0> Set Interface Event
|
||||
// <o10.0> Set/Clear Feature Event
|
||||
// </h>
|
||||
// </h>
|
||||
*/
|
||||
|
||||
#define USB_POWER_EVENT 0
|
||||
#define USB_RESET_EVENT 1
|
||||
#define USB_SUSPEND_EVENT 0
|
||||
#define USB_RESUME_EVENT 0
|
||||
#define USB_WAKEUP_EVENT 0
|
||||
#define USB_SOF_EVENT 0
|
||||
#define USB_ERROR_EVENT 0
|
||||
#define USB_EP_EVENT 0x0027
|
||||
#define USB_CONFIGURE_EVENT 1
|
||||
#define USB_INTERFACE_EVENT 0
|
||||
#define USB_FEATURE_EVENT 0
|
||||
|
||||
|
||||
/*
|
||||
// <e0> USB Class Support
|
||||
// <i> enables USB Class specific Requests
|
||||
// <e1> Human Interface Device (HID)
|
||||
// <o2> Interface Number <0-255>
|
||||
// </e>
|
||||
// <e3> Mass Storage
|
||||
// <o4> Interface Number <0-255>
|
||||
// </e>
|
||||
// <e5> Audio Device
|
||||
// <o6> Control Interface Number <0-255>
|
||||
// <o7> Streaming Interface 1 Number <0-255>
|
||||
// <o8> Streaming Interface 2 Number <0-255>
|
||||
// </e>
|
||||
// <e9> Communication Device
|
||||
// <o10> Control Interface Number <0-255>
|
||||
// <o11> Bulk Interface Number <0-255>
|
||||
// <o12> Max Communication Device Buffer Size
|
||||
// <8=> 8 Bytes <16=> 16 Bytes <32=> 32 Bytes <64=> 64 Bytes
|
||||
// </e>
|
||||
// </e>
|
||||
*/
|
||||
|
||||
#define USB_CLASS 1
|
||||
#define USB_HID 0
|
||||
#define USB_HID_IF_NUM 0
|
||||
#define USB_MSC 1
|
||||
#define USB_MSC_IF_NUM 2
|
||||
#define USB_AUDIO 0
|
||||
#define USB_ADC_CIF_NUM 0
|
||||
#define USB_ADC_SIF1_NUM 1
|
||||
#define USB_ADC_SIF2_NUM 2
|
||||
#define USB_CDC 1
|
||||
#define USB_CDC_CIF_NUM 0
|
||||
#define USB_CDC_DIF_NUM 1
|
||||
#define USB_CDC_BUFSIZE 64
|
||||
|
||||
/*
|
||||
// <e0> USB Vendor Support
|
||||
// <i> enables USB Vendor specific Requests
|
||||
// </e>
|
||||
*/
|
||||
#define USB_VENDOR 0
|
||||
|
||||
|
||||
#endif /* __USBCFG_H__ */
|
|
@ -1,815 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbcore.c
|
||||
* Purpose: USB Core Module
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*----------------------------------------------------------------------------
|
||||
* History:
|
||||
* V1.20 Added vendor specific requests
|
||||
* Changed string descriptor handling
|
||||
* Reworked Endpoint0
|
||||
* V1.00 Initial Version
|
||||
*----------------------------------------------------------------------------*/
|
||||
extern "C" {
|
||||
#include "lpc_types.h"
|
||||
}
|
||||
#include "usb.h"
|
||||
#include "usbcfg.h"
|
||||
#include "usbhw.h"
|
||||
#include "usbcore.h"
|
||||
#include "usbdesc.h"
|
||||
#include "usbuser.h"
|
||||
|
||||
#include "msc.h"
|
||||
#include "mscuser.h"
|
||||
extern MSC_CSW CSW;
|
||||
|
||||
#include "cdc.h"
|
||||
#include "cdcuser.h"
|
||||
|
||||
#define __packed __attribute__((__packed__))
|
||||
|
||||
uint16_t USB_DeviceStatus;
|
||||
uint8_t USB_DeviceAddress;
|
||||
uint8_t USB_Configuration;
|
||||
uint32_t USB_EndPointMask;
|
||||
uint32_t USB_EndPointHalt;
|
||||
uint32_t USB_EndPointStall; /* EP must stay stalled */
|
||||
uint8_t USB_NumInterfaces;
|
||||
uint8_t USB_AltSetting[USB_IF_NUM];
|
||||
|
||||
uint8_t EP0Buf[USB_MAX_PACKET0];
|
||||
|
||||
USB_EP_DATA EP0Data;
|
||||
|
||||
USB_SETUP_PACKET SetupPacket;
|
||||
|
||||
/*
|
||||
* Reset USB Core
|
||||
* Parameters: None
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_ResetCore(void) {
|
||||
|
||||
USB_DeviceStatus = USB_POWER;
|
||||
USB_DeviceAddress = 0;
|
||||
USB_Configuration = 0;
|
||||
USB_EndPointMask = 0x00010001;
|
||||
USB_EndPointHalt = 0x00000000;
|
||||
USB_EndPointStall = 0x00000000;
|
||||
}
|
||||
|
||||
/*
|
||||
* USB Request - Setup Stage
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_SetupStage(void) {
|
||||
USB_ReadEP(0x00, (uint8_t *) &SetupPacket);
|
||||
}
|
||||
|
||||
/*
|
||||
* USB Request - Data In Stage
|
||||
* Parameters: None (global EP0Data)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_DataInStage(void) {
|
||||
uint32_t cnt;
|
||||
|
||||
if (EP0Data.Count > USB_MAX_PACKET0) {
|
||||
cnt = USB_MAX_PACKET0;
|
||||
} else {
|
||||
cnt = EP0Data.Count;
|
||||
}
|
||||
cnt = USB_WriteEP(0x80, EP0Data.pData, cnt);
|
||||
EP0Data.pData += cnt;
|
||||
EP0Data.Count -= cnt;
|
||||
}
|
||||
|
||||
/*
|
||||
* USB Request - Data Out Stage
|
||||
* Parameters: None (global EP0Data)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_DataOutStage(void) {
|
||||
uint32_t cnt;
|
||||
|
||||
cnt = USB_ReadEP(0x00, EP0Data.pData);
|
||||
EP0Data.pData += cnt;
|
||||
EP0Data.Count -= cnt;
|
||||
}
|
||||
|
||||
/*
|
||||
* USB Request - Status In Stage
|
||||
* Parameters: None
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_StatusInStage(void) {
|
||||
USB_WriteEP(0x80, nullptr, 0);
|
||||
}
|
||||
|
||||
/*
|
||||
* USB Request - Status Out Stage
|
||||
* Parameters: None
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_StatusOutStage(void) {
|
||||
USB_ReadEP(0x00, EP0Buf);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get Status USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqGetStatus(void) {
|
||||
uint32_t n, m;
|
||||
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
EP0Data.pData = (uint8_t *) &USB_DeviceStatus;
|
||||
break;
|
||||
case REQUEST_TO_INTERFACE:
|
||||
if ((USB_Configuration != 0) && (SetupPacket.wIndex.WB.L < USB_NumInterfaces)) {
|
||||
*((__packed uint16_t *) EP0Buf) = 0;
|
||||
*((uint16_t *) EP0Buf) = 0;
|
||||
EP0Data.pData = EP0Buf;
|
||||
} else {
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
case REQUEST_TO_ENDPOINT:
|
||||
n = SetupPacket.wIndex.WB.L & 0x8F;
|
||||
m = (n & 0x80) ? ((1 << 16) << (n & 0x0F)) : (1 << n);
|
||||
if (((USB_Configuration != 0) || ((n & 0x0F) == 0)) && (USB_EndPointMask & m)) {
|
||||
*((__packed uint16_t *) EP0Buf) = (USB_EndPointHalt & m) ? 1 : 0;
|
||||
*((uint16_t *) EP0Buf) = (USB_EndPointHalt & m) ? 1 : 0;
|
||||
EP0Data.pData = EP0Buf;
|
||||
} else {
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Set/Clear Feature USB Request
|
||||
* Parameters: sc: 0 - Clear, 1 - Set
|
||||
* (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqSetClrFeature(uint32_t sc) {
|
||||
uint32_t n, m;
|
||||
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
if (SetupPacket.wValue.W == USB_FEATURE_REMOTE_WAKEUP) {
|
||||
if (sc) {
|
||||
USB_WakeUpCfg(TRUE);
|
||||
USB_DeviceStatus |= USB_GETSTATUS_REMOTE_WAKEUP;
|
||||
} else {
|
||||
USB_WakeUpCfg(FALSE);
|
||||
USB_DeviceStatus &= ~USB_GETSTATUS_REMOTE_WAKEUP;
|
||||
}
|
||||
} else {
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
case REQUEST_TO_INTERFACE:
|
||||
return (FALSE);
|
||||
case REQUEST_TO_ENDPOINT:
|
||||
n = SetupPacket.wIndex.WB.L & 0x8F;
|
||||
m = (n & 0x80) ? ((1 << 16) << (n & 0x0F)) : (1 << n);
|
||||
if ((USB_Configuration != 0) && ((n & 0x0F) != 0) && (USB_EndPointMask & m)) {
|
||||
if (SetupPacket.wValue.W == USB_FEATURE_ENDPOINT_STALL) {
|
||||
if (sc) {
|
||||
USB_SetStallEP(n);
|
||||
USB_EndPointHalt |= m;
|
||||
} else {
|
||||
if ((USB_EndPointStall & m) != 0) {
|
||||
return (TRUE);
|
||||
}
|
||||
USB_ClrStallEP(n);
|
||||
#if (USB_MSC)
|
||||
if ((n == MSC_EP_IN) && ((USB_EndPointHalt & m) != 0)) {
|
||||
/* Compliance Test: rewrite CSW after unstall */
|
||||
if (CSW.dSignature == MSC_CSW_Signature) {
|
||||
USB_WriteEP(MSC_EP_IN, (uint8_t *) &CSW, sizeof(CSW));
|
||||
}
|
||||
}
|
||||
#endif
|
||||
USB_EndPointHalt &= ~m;
|
||||
}
|
||||
} else {
|
||||
return (FALSE);
|
||||
}
|
||||
} else {
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Set Address USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqSetAddress(void) {
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
USB_DeviceAddress = 0x80 | SetupPacket.wValue.WB.L;
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get Descriptor USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqGetDescriptor(void) {
|
||||
uint8_t *pD;
|
||||
uint32_t len, n;
|
||||
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
switch (SetupPacket.wValue.WB.H) {
|
||||
case USB_DEVICE_DESCRIPTOR_TYPE:
|
||||
EP0Data.pData = (uint8_t *) USB_DeviceDescriptor;
|
||||
len = USB_DEVICE_DESC_SIZE;
|
||||
break;
|
||||
case USB_CONFIGURATION_DESCRIPTOR_TYPE:
|
||||
pD = (uint8_t *) USB_ConfigDescriptor;
|
||||
for (n = 0; n != SetupPacket.wValue.WB.L; n++) {
|
||||
if (((USB_CONFIGURATION_DESCRIPTOR *) pD)->bLength != 0) {
|
||||
pD += ((USB_CONFIGURATION_DESCRIPTOR *) pD)->wTotalLength;
|
||||
}
|
||||
}
|
||||
if (((USB_CONFIGURATION_DESCRIPTOR *) pD)->bLength == 0) {
|
||||
return (FALSE);
|
||||
}
|
||||
EP0Data.pData = pD;
|
||||
len = ((USB_CONFIGURATION_DESCRIPTOR *) pD)->wTotalLength;
|
||||
break;
|
||||
case USB_STRING_DESCRIPTOR_TYPE:
|
||||
pD = (uint8_t *) USB_StringDescriptor;
|
||||
for (n = 0; n != SetupPacket.wValue.WB.L; n++) {
|
||||
if (((USB_STRING_DESCRIPTOR *) pD)->bLength != 0) {
|
||||
pD += ((USB_STRING_DESCRIPTOR *) pD)->bLength;
|
||||
}
|
||||
}
|
||||
if (((USB_STRING_DESCRIPTOR *) pD)->bLength == 0) {
|
||||
return (FALSE);
|
||||
}
|
||||
EP0Data.pData = pD;
|
||||
len = ((USB_STRING_DESCRIPTOR *) EP0Data.pData)->bLength;
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
case REQUEST_TO_INTERFACE:
|
||||
switch (SetupPacket.wValue.WB.H) {
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
// break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
|
||||
if (EP0Data.Count > len) {
|
||||
EP0Data.Count = len;
|
||||
}
|
||||
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get Configuration USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqGetConfiguration(void) {
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
EP0Data.pData = &USB_Configuration;
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Set Configuration USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqSetConfiguration(void) {
|
||||
USB_COMMON_DESCRIPTOR *pD;
|
||||
uint32_t alt = 0;
|
||||
uint32_t n, m;
|
||||
uint32_t tmp;
|
||||
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
|
||||
if (SetupPacket.wValue.WB.L) {
|
||||
pD = (USB_COMMON_DESCRIPTOR *) USB_ConfigDescriptor;
|
||||
while (pD->bLength) {
|
||||
switch (pD->bDescriptorType) {
|
||||
case USB_CONFIGURATION_DESCRIPTOR_TYPE:
|
||||
if (((USB_CONFIGURATION_DESCRIPTOR *) pD)->bConfigurationValue == SetupPacket.wValue.WB.L) {
|
||||
USB_Configuration = SetupPacket.wValue.WB.L;
|
||||
USB_NumInterfaces = ((USB_CONFIGURATION_DESCRIPTOR *) pD)->bNumInterfaces;
|
||||
for (n = 0; n < USB_IF_NUM; n++) {
|
||||
USB_AltSetting[n] = 0;
|
||||
}
|
||||
for (n = 1; n < 16; n++) {
|
||||
if (USB_EndPointMask & (1 << n)) {
|
||||
USB_DisableEP(n);
|
||||
}
|
||||
if (USB_EndPointMask & ((1 << 16) << n)) {
|
||||
USB_DisableEP(n | 0x80);
|
||||
}
|
||||
}
|
||||
USB_EndPointMask = 0x00010001;
|
||||
USB_EndPointHalt = 0x00000000;
|
||||
USB_EndPointStall = 0x00000000;
|
||||
USB_Configure(TRUE);
|
||||
if (((USB_CONFIGURATION_DESCRIPTOR *) pD)->bmAttributes & USB_CONFIG_POWERED_MASK) {
|
||||
USB_DeviceStatus |= USB_GETSTATUS_SELF_POWERED;
|
||||
} else {
|
||||
USB_DeviceStatus &= ~(USB_GETSTATUS_SELF_POWERED);
|
||||
}
|
||||
} else {
|
||||
// (uint8_t *)pD += ((USB_CONFIGURATION_DESCRIPTOR *)pD)->wTotalLength;
|
||||
tmp = (uint32_t) pD;
|
||||
tmp += ((USB_CONFIGURATION_DESCRIPTOR *) pD)->wTotalLength;
|
||||
pD = (USB_COMMON_DESCRIPTOR *) tmp;
|
||||
continue;
|
||||
}
|
||||
break;
|
||||
case USB_INTERFACE_DESCRIPTOR_TYPE:
|
||||
alt = ((USB_INTERFACE_DESCRIPTOR *) pD)->bAlternateSetting;
|
||||
break;
|
||||
case USB_ENDPOINT_DESCRIPTOR_TYPE:
|
||||
if (alt == 0) {
|
||||
n = ((USB_ENDPOINT_DESCRIPTOR *) pD)->bEndpointAddress & 0x8F;
|
||||
m = (n & 0x80) ? ((1 << 16) << (n & 0x0F)) : (1 << n);
|
||||
USB_EndPointMask |= m;
|
||||
USB_ConfigEP((USB_ENDPOINT_DESCRIPTOR *) pD);
|
||||
USB_EnableEP(n);
|
||||
USB_ResetEP(n);
|
||||
}
|
||||
break;
|
||||
}
|
||||
// (uint8_t *)pD += pD->bLength;
|
||||
tmp = (uint32_t) pD;
|
||||
tmp += pD->bLength;
|
||||
pD = (USB_COMMON_DESCRIPTOR *) tmp;
|
||||
}
|
||||
} else {
|
||||
USB_Configuration = 0;
|
||||
for (n = 1; n < 16; n++) {
|
||||
if (USB_EndPointMask & (1 << n)) {
|
||||
USB_DisableEP(n);
|
||||
}
|
||||
if (USB_EndPointMask & ((1 << 16) << n)) {
|
||||
USB_DisableEP(n | 0x80);
|
||||
}
|
||||
}
|
||||
USB_EndPointMask = 0x00010001;
|
||||
USB_EndPointHalt = 0x00000000;
|
||||
USB_EndPointStall = 0x00000000;
|
||||
USB_Configure(FALSE);
|
||||
}
|
||||
|
||||
if (USB_Configuration != SetupPacket.wValue.WB.L) {
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Get Interface USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
__inline uint32_t USB_ReqGetInterface(void) {
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_INTERFACE:
|
||||
if ((USB_Configuration != 0) && (SetupPacket.wIndex.WB.L < USB_NumInterfaces)) {
|
||||
EP0Data.pData = USB_AltSetting + SetupPacket.wIndex.WB.L;
|
||||
} else {
|
||||
return (FALSE);
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
return (TRUE);
|
||||
}
|
||||
|
||||
/*
|
||||
* Set Interface USB Request
|
||||
* Parameters: None (global SetupPacket)
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
__inline uint32_t USB_ReqSetInterface(void) {
|
||||
USB_COMMON_DESCRIPTOR *pD;
|
||||
uint32_t ifn = 0, alt = 0, old = 0, msk = 0;
|
||||
uint32_t n, m;
|
||||
uint32_t set;
|
||||
uint32_t tmp;
|
||||
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_INTERFACE:
|
||||
if (USB_Configuration == 0)
|
||||
return (FALSE);
|
||||
set = FALSE;
|
||||
pD = (USB_COMMON_DESCRIPTOR *) USB_ConfigDescriptor;
|
||||
while (pD->bLength) {
|
||||
switch (pD->bDescriptorType) {
|
||||
case USB_CONFIGURATION_DESCRIPTOR_TYPE:
|
||||
if (((USB_CONFIGURATION_DESCRIPTOR *) pD)->bConfigurationValue != USB_Configuration) {
|
||||
// (uint8_t *)pD += ((USB_CONFIGURATION_DESCRIPTOR *)pD)->wTotalLength;
|
||||
tmp = (uint32_t) pD;
|
||||
tmp += ((USB_CONFIGURATION_DESCRIPTOR *) pD)->wTotalLength;
|
||||
pD = (USB_COMMON_DESCRIPTOR *) tmp;
|
||||
|
||||
continue;
|
||||
}
|
||||
break;
|
||||
case USB_INTERFACE_DESCRIPTOR_TYPE:
|
||||
ifn = ((USB_INTERFACE_DESCRIPTOR *) pD)->bInterfaceNumber;
|
||||
alt = ((USB_INTERFACE_DESCRIPTOR *) pD)->bAlternateSetting;
|
||||
msk = 0;
|
||||
if ((ifn == SetupPacket.wIndex.WB.L) && (alt == SetupPacket.wValue.WB.L)) {
|
||||
set = TRUE;
|
||||
old = USB_AltSetting[ifn];
|
||||
USB_AltSetting[ifn] = (uint8_t) alt;
|
||||
}
|
||||
break;
|
||||
case USB_ENDPOINT_DESCRIPTOR_TYPE:
|
||||
if (ifn == SetupPacket.wIndex.WB.L) {
|
||||
n = ((USB_ENDPOINT_DESCRIPTOR *) pD)->bEndpointAddress & 0x8F;
|
||||
m = (n & 0x80) ? ((1 << 16) << (n & 0x0F)) : (1 << n);
|
||||
if (alt == SetupPacket.wValue.WB.L) {
|
||||
USB_EndPointMask |= m;
|
||||
USB_EndPointHalt &= ~m;
|
||||
USB_ConfigEP((USB_ENDPOINT_DESCRIPTOR *) pD);
|
||||
USB_EnableEP(n);
|
||||
USB_ResetEP(n);
|
||||
msk |= m;
|
||||
} else if ((alt == old) && ((msk & m) == 0)) {
|
||||
USB_EndPointMask &= ~m;
|
||||
USB_EndPointHalt &= ~m;
|
||||
USB_DisableEP(n);
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
// (uint8_t *)pD += pD->bLength;
|
||||
tmp = (uint32_t) pD;
|
||||
tmp += pD->bLength;
|
||||
pD = (USB_COMMON_DESCRIPTOR *) tmp;
|
||||
}
|
||||
break;
|
||||
default:
|
||||
return (FALSE);
|
||||
}
|
||||
|
||||
return (set);
|
||||
}
|
||||
|
||||
/*
|
||||
* USB Endpoint 0 Event Callback
|
||||
* Parameters: event
|
||||
* Return Value: none
|
||||
*/
|
||||
|
||||
void USB_EndPoint0(uint32_t event) {
|
||||
|
||||
switch (event) {
|
||||
case USB_EVT_SETUP:
|
||||
USB_SetupStage();
|
||||
USB_DirCtrlEP(SetupPacket.bmRequestType.BM.Dir);
|
||||
EP0Data.Count = SetupPacket.wLength; /* Number of bytes to transfer */
|
||||
switch (SetupPacket.bmRequestType.BM.Type) {
|
||||
|
||||
case REQUEST_STANDARD:
|
||||
switch (SetupPacket.bRequest) {
|
||||
case USB_REQUEST_GET_STATUS:
|
||||
if (!USB_ReqGetStatus()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_DataInStage();
|
||||
break;
|
||||
|
||||
case USB_REQUEST_CLEAR_FEATURE:
|
||||
if (!USB_ReqSetClrFeature(0)) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_StatusInStage();
|
||||
#if USB_FEATURE_EVENT
|
||||
USB_Feature_Event();
|
||||
#endif
|
||||
break;
|
||||
|
||||
case USB_REQUEST_SET_FEATURE:
|
||||
if (!USB_ReqSetClrFeature(1)) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_StatusInStage();
|
||||
#if USB_FEATURE_EVENT
|
||||
USB_Feature_Event();
|
||||
#endif
|
||||
break;
|
||||
|
||||
case USB_REQUEST_SET_ADDRESS:
|
||||
if (!USB_ReqSetAddress()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_StatusInStage();
|
||||
break;
|
||||
|
||||
case USB_REQUEST_GET_DESCRIPTOR:
|
||||
if (!USB_ReqGetDescriptor()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_DataInStage();
|
||||
break;
|
||||
|
||||
case USB_REQUEST_SET_DESCRIPTOR:
|
||||
USB_SetStallEP(0x00);
|
||||
EP0Data.Count = 0;
|
||||
break;
|
||||
|
||||
case USB_REQUEST_GET_CONFIGURATION:
|
||||
if (!USB_ReqGetConfiguration()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_DataInStage();
|
||||
break;
|
||||
|
||||
case USB_REQUEST_SET_CONFIGURATION:
|
||||
if (!USB_ReqSetConfiguration()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_StatusInStage();
|
||||
#if USB_CONFIGURE_EVENT
|
||||
USB_Configure_Event();
|
||||
#endif
|
||||
break;
|
||||
|
||||
case USB_REQUEST_GET_INTERFACE:
|
||||
if (!USB_ReqGetInterface()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_DataInStage();
|
||||
break;
|
||||
|
||||
case USB_REQUEST_SET_INTERFACE:
|
||||
if (!USB_ReqSetInterface()) {
|
||||
goto stall_i;
|
||||
}
|
||||
USB_StatusInStage();
|
||||
#if USB_INTERFACE_EVENT
|
||||
USB_Interface_Event();
|
||||
#endif
|
||||
break;
|
||||
|
||||
default:
|
||||
goto stall_i;
|
||||
}
|
||||
break; /* end case REQUEST_STANDARD */
|
||||
|
||||
case REQUEST_CLASS:
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
|
||||
case REQUEST_TO_DEVICE:
|
||||
goto stall_i;
|
||||
/* not supported */
|
||||
|
||||
case REQUEST_TO_INTERFACE:
|
||||
if (SetupPacket.wIndex.WB.L == USB_MSC_IF_NUM) { /* IF number correct? */
|
||||
switch (SetupPacket.bRequest) {
|
||||
case MSC_REQUEST_RESET:
|
||||
if ((SetupPacket.wValue.W == 0) && /* RESET with invalid parameters -> STALL */
|
||||
(SetupPacket.wLength == 0)) {
|
||||
if (MSC_Reset()) {
|
||||
USB_StatusInStage();
|
||||
goto setup_class_ok;
|
||||
}
|
||||
}
|
||||
break;
|
||||
case MSC_REQUEST_GET_MAX_LUN:
|
||||
if ((SetupPacket.wValue.W == 0) && /* GET_MAX_LUN with invalid parameters -> STALL */
|
||||
(SetupPacket.wLength == 1)) {
|
||||
if (MSC_GetMaxLUN()) {
|
||||
EP0Data.pData = EP0Buf;
|
||||
USB_DataInStage();
|
||||
goto setup_class_ok;
|
||||
}
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
if ((SetupPacket.wIndex.WB.L == USB_CDC_CIF_NUM) || /* IF number correct? */
|
||||
(SetupPacket.wIndex.WB.L == USB_CDC_DIF_NUM)) {
|
||||
switch (SetupPacket.bRequest) {
|
||||
case CDC_SEND_ENCAPSULATED_COMMAND:
|
||||
EP0Data.pData = EP0Buf; /* data to be received, see USB_EVT_OUT */
|
||||
goto setup_class_ok;
|
||||
case CDC_GET_ENCAPSULATED_RESPONSE:
|
||||
if (CDC_GetEncapsulatedResponse()) {
|
||||
EP0Data.pData = EP0Buf; /* point to data to be sent */
|
||||
USB_DataInStage(); /* send requested data */
|
||||
goto setup_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_SET_COMM_FEATURE:
|
||||
EP0Data.pData = EP0Buf; /* data to be received, see USB_EVT_OUT */
|
||||
goto setup_class_ok;
|
||||
case CDC_GET_COMM_FEATURE:
|
||||
if (CDC_GetCommFeature(SetupPacket.wValue.W)) {
|
||||
EP0Data.pData = EP0Buf; /* point to data to be sent */
|
||||
USB_DataInStage(); /* send requested data */
|
||||
goto setup_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_CLEAR_COMM_FEATURE:
|
||||
if (CDC_ClearCommFeature(SetupPacket.wValue.W)) {
|
||||
USB_StatusInStage(); /* send Acknowledge */
|
||||
goto setup_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_SET_LINE_CODING:
|
||||
EP0Data.pData = EP0Buf; /* data to be received, see USB_EVT_OUT */
|
||||
goto setup_class_ok;
|
||||
case CDC_GET_LINE_CODING:
|
||||
if (CDC_GetLineCoding()) {
|
||||
EP0Data.pData = EP0Buf; /* point to data to be sent */
|
||||
USB_DataInStage(); /* send requested data */
|
||||
goto setup_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_SET_CONTROL_LINE_STATE:
|
||||
if (CDC_SetControlLineState(SetupPacket.wValue.W)) {
|
||||
USB_StatusInStage(); /* send Acknowledge */
|
||||
goto setup_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_SEND_BREAK:
|
||||
if (CDC_SendBreak(SetupPacket.wValue.W)) {
|
||||
USB_StatusInStage(); /* send Acknowledge */
|
||||
goto setup_class_ok;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
goto stall_i;
|
||||
/* not supported */
|
||||
/* end case REQUEST_TO_INTERFACE */
|
||||
|
||||
case REQUEST_TO_ENDPOINT:
|
||||
goto stall_i;
|
||||
/* end case REQUEST_TO_ENDPOINT */
|
||||
|
||||
default:
|
||||
goto stall_i;
|
||||
}
|
||||
setup_class_ok: /* request finished successfully */
|
||||
break; /* end case REQUEST_CLASS */
|
||||
|
||||
default:
|
||||
stall_i: USB_SetStallEP(0x80);
|
||||
EP0Data.Count = 0;
|
||||
break;
|
||||
}
|
||||
break; /* end case USB_EVT_SETUP */
|
||||
|
||||
case USB_EVT_OUT:
|
||||
if (SetupPacket.bmRequestType.BM.Dir == REQUEST_HOST_TO_DEVICE) {
|
||||
if (EP0Data.Count) { /* still data to receive ? */
|
||||
USB_DataOutStage(); /* receive data */
|
||||
if (EP0Data.Count == 0) { /* data complete ? */
|
||||
switch (SetupPacket.bmRequestType.BM.Type) {
|
||||
|
||||
case REQUEST_STANDARD:
|
||||
goto stall_i;
|
||||
/* not supported */
|
||||
|
||||
case REQUEST_CLASS:
|
||||
switch (SetupPacket.bmRequestType.BM.Recipient) {
|
||||
case REQUEST_TO_DEVICE:
|
||||
goto stall_i;
|
||||
/* not supported */
|
||||
|
||||
case REQUEST_TO_INTERFACE:
|
||||
if ((SetupPacket.wIndex.WB.L == USB_CDC_CIF_NUM) || /* IF number correct? */
|
||||
(SetupPacket.wIndex.WB.L == USB_CDC_DIF_NUM)) {
|
||||
switch (SetupPacket.bRequest) {
|
||||
case CDC_SEND_ENCAPSULATED_COMMAND:
|
||||
if (CDC_SendEncapsulatedCommand()) {
|
||||
USB_StatusInStage(); /* send Acknowledge */
|
||||
goto out_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_SET_COMM_FEATURE:
|
||||
if (CDC_SetCommFeature(SetupPacket.wValue.W)) {
|
||||
USB_StatusInStage(); /* send Acknowledge */
|
||||
goto out_class_ok;
|
||||
}
|
||||
break;
|
||||
case CDC_SET_LINE_CODING:
|
||||
if (CDC_SetLineCoding()) {
|
||||
USB_StatusInStage(); /* send Acknowledge */
|
||||
goto out_class_ok;
|
||||
}
|
||||
break;
|
||||
}
|
||||
}
|
||||
goto stall_i;
|
||||
/* end case REQUEST_TO_INTERFACE */
|
||||
|
||||
case REQUEST_TO_ENDPOINT:
|
||||
goto stall_i;
|
||||
/* end case REQUEST_TO_ENDPOINT */
|
||||
|
||||
default:
|
||||
goto stall_i;
|
||||
}
|
||||
out_class_ok: /* request finished successfully */
|
||||
break; /* end case REQUEST_CLASS */
|
||||
default:
|
||||
goto stall_i;
|
||||
}
|
||||
}
|
||||
}
|
||||
} else {
|
||||
USB_StatusOutStage(); /* receive Acknowledge */
|
||||
}
|
||||
break; /* end case USB_EVT_OUT */
|
||||
|
||||
case USB_EVT_IN:
|
||||
if (SetupPacket.bmRequestType.BM.Dir == REQUEST_DEVICE_TO_HOST) {
|
||||
USB_DataInStage(); /* send data */
|
||||
} else {
|
||||
if (USB_DeviceAddress & 0x80) {
|
||||
USB_DeviceAddress &= 0x7F;
|
||||
USB_SetAddress(USB_DeviceAddress);
|
||||
}
|
||||
}
|
||||
break; /* end case USB_EVT_IN */
|
||||
|
||||
case USB_EVT_OUT_STALL:
|
||||
USB_ClrStallEP(0x00);
|
||||
break;
|
||||
|
||||
case USB_EVT_IN_STALL:
|
||||
USB_ClrStallEP(0x80);
|
||||
break;
|
||||
|
||||
}
|
||||
}
|
|
@ -1,52 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbcore.h
|
||||
* Purpose: USB Core Definitions
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC microcontroller devices only. Nothing else
|
||||
* gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USBCORE_H__
|
||||
#define __USBCORE_H__
|
||||
|
||||
|
||||
/* USB Endpoint Data Structure */
|
||||
typedef struct _USB_EP_DATA {
|
||||
uint8_t *pData;
|
||||
uint16_t Count;
|
||||
} USB_EP_DATA;
|
||||
|
||||
/* USB Core Global Variables */
|
||||
extern uint16_t USB_DeviceStatus;
|
||||
extern uint8_t USB_DeviceAddress;
|
||||
extern uint8_t USB_Configuration;
|
||||
extern uint32_t USB_EndPointMask;
|
||||
extern uint32_t USB_EndPointHalt;
|
||||
extern uint32_t USB_EndPointStall;
|
||||
extern uint8_t USB_AltSetting[USB_IF_NUM];
|
||||
|
||||
/* USB Endpoint 0 Buffer */
|
||||
extern uint8_t EP0Buf[USB_MAX_PACKET0];
|
||||
|
||||
/* USB Endpoint 0 Data Info */
|
||||
extern USB_EP_DATA EP0Data;
|
||||
|
||||
/* USB Setup Packet */
|
||||
extern USB_SETUP_PACKET SetupPacket;
|
||||
|
||||
/* USB Core Functions */
|
||||
extern void USB_ResetCore (void);
|
||||
|
||||
|
||||
|
||||
#endif /* __USBCORE_H__ */
|
|
@ -1,257 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbdesc.c
|
||||
* Purpose: USB Descriptors
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC microcontroller devices only. Nothing else
|
||||
* gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*----------------------------------------------------------------------------
|
||||
* History:
|
||||
* V1.20 Changed string descriptor handling
|
||||
* V1.00 Initial Version
|
||||
*---------------------------------------------------------------------------*/
|
||||
extern "C" {
|
||||
#include "lpc_types.h"
|
||||
}
|
||||
|
||||
#include "usb.h"
|
||||
#include "cdc.h"
|
||||
#include "msc.h"
|
||||
#include "usbcfg.h"
|
||||
#include "usbdesc.h"
|
||||
|
||||
|
||||
/* USB Standard Device Descriptor */
|
||||
const uint8_t USB_DeviceDescriptor[] = {
|
||||
USB_DEVICE_DESC_SIZE, /* bLength */
|
||||
USB_DEVICE_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
WBVAL(0x0200), /* 2.0 */ /* bcdUSB */
|
||||
USB_DEVICE_CLASS_MISCELLANEOUS, /* bDeviceClass Composite*/
|
||||
0x02, /* bDeviceSubClass */
|
||||
0x01, /* bDeviceProtocol */
|
||||
USB_MAX_PACKET0, /* bMaxPacketSize0 */
|
||||
WBVAL(0x1d50), /* idVendor */
|
||||
WBVAL(0x6029), /* idProduct */
|
||||
WBVAL(0x0100), /* 1.00 */ /* bcdDevice */
|
||||
0x01, /* iManufacturer */
|
||||
0x02, /* iProduct */
|
||||
0x03, /* iSerialNumber */
|
||||
0x01 /* bNumConfigurations: one possible configuration*/
|
||||
};
|
||||
|
||||
/* USB Configuration Descriptor */
|
||||
/* All Descriptors (Configuration, Interface, Endpoint, Class, Vendor */
|
||||
const uint8_t USB_ConfigDescriptor[] = {
|
||||
/* Configuration 1 */
|
||||
USB_CONFIGUARTION_DESC_SIZE, /* bLength */
|
||||
USB_CONFIGURATION_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
WBVAL( /* wTotalLength */
|
||||
1*USB_CONFIGUARTION_DESC_SIZE +
|
||||
// Interface Association Descriptor
|
||||
8 +
|
||||
//CDC Control Interface
|
||||
1*USB_INTERFACE_DESC_SIZE + /* communication interface */
|
||||
0x0013 + /* CDC functions */
|
||||
1*USB_ENDPOINT_DESC_SIZE + /* interrupt endpoint */
|
||||
//CDC Data Interface
|
||||
1*USB_INTERFACE_DESC_SIZE + /* data interface */
|
||||
2*USB_ENDPOINT_DESC_SIZE + /* bulk endpoints */
|
||||
//MSC Interface
|
||||
1*USB_INTERFACE_DESC_SIZE +
|
||||
2*USB_ENDPOINT_DESC_SIZE
|
||||
),
|
||||
0x03, /* bNumInterfaces */
|
||||
0x01, /* bConfigurationValue: 0x01 is used to select this configuration */
|
||||
0x00, /* iConfiguration: no string to describe this configuration */
|
||||
USB_CONFIG_BUS_POWERED, /* bmAttributes */
|
||||
USB_CONFIG_POWER_MA(500), /* bMaxPower, device power consumption is 500 mA */
|
||||
|
||||
|
||||
/* Interface Association Descriptor */
|
||||
0x08,
|
||||
0x0B, //DescriptorType : Interface Association
|
||||
0x00, //FirstInterface
|
||||
0x02, //InterfaceCount
|
||||
0x02, //FunctionClass
|
||||
0x02, //FunctionSubClass
|
||||
0x01, //FunctionProtocol
|
||||
0x00, //Function
|
||||
|
||||
/* Interface 0, Alternate Setting 0, Communication class interface descriptor */
|
||||
USB_INTERFACE_DESC_SIZE, /* bLength */
|
||||
USB_INTERFACE_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_CDC_CIF_NUM, /* bInterfaceNumber: Number of Interface */
|
||||
0x00, /* bAlternateSetting: Alternate setting */
|
||||
0x01, /* bNumEndpoints: One endpoint used */
|
||||
CDC_COMMUNICATION_INTERFACE_CLASS, /* bInterfaceClass: Communication Interface Class */
|
||||
CDC_ABSTRACT_CONTROL_MODEL, /* bInterfaceSubClass: Abstract Control Model */
|
||||
0x00, /* bInterfaceProtocol: no protocol used */
|
||||
0x00, /* iInterface: */
|
||||
|
||||
/*Header Functional Descriptor*/
|
||||
0x05, /* bLength: Endpoint Descriptor size */
|
||||
CDC_CS_INTERFACE, /* bDescriptorType: CS_INTERFACE */
|
||||
CDC_HEADER, /* bDescriptorSubtype: Header Func Desc */
|
||||
WBVAL(CDC_V1_10), /* 1.10 */ /* bcdCDC */
|
||||
|
||||
/*Call Management Functional Descriptor*/
|
||||
0x05, /* bFunctionLength */
|
||||
CDC_CS_INTERFACE, /* bDescriptorType: CS_INTERFACE */
|
||||
CDC_CALL_MANAGEMENT, /* bDescriptorSubtype: Call Management Func Desc */
|
||||
CDC_CALLMGMT_CAP_CALLMGMT | CDC_CALLMGMT_CAP_DATAINTF, /* bmCapabilities: device handles call management */
|
||||
0x01, /* bDataInterface: CDC data IF ID */
|
||||
|
||||
/*Abstract Control Management Functional Descriptor*/
|
||||
0x04, /* bFunctionLength */
|
||||
CDC_CS_INTERFACE, /* bDescriptorType: CS_INTERFACE */
|
||||
CDC_ABSTRACT_CONTROL_MANAGEMENT, /* bDescriptorSubtype: Abstract Control Management desc */
|
||||
CDC_ACM_CAP_LINE | CDC_ACM_CAP_BRK,/* bmCapabilities: SET_LINE_CODING, GET_LINE_CODING, SET_CONTROL_LINE_STATE supported */
|
||||
|
||||
/*Union Functional Descriptor*/
|
||||
0x05, /* bFunctionLength */
|
||||
CDC_CS_INTERFACE, /* bDescriptorType: CS_INTERFACE */
|
||||
CDC_UNION, /* bDescriptorSubtype: Union func desc */
|
||||
USB_CDC_CIF_NUM, /* bMasterInterface: Communication class interface is master */
|
||||
USB_CDC_DIF_NUM, /* bSlaveInterface0: Data class interface is slave 0 */
|
||||
|
||||
/*Endpoint 1 Descriptor*/ /* event notification (optional) */
|
||||
USB_ENDPOINT_DESC_SIZE, /* bLength */
|
||||
USB_ENDPOINT_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_ENDPOINT_IN(1), /* bEndpointAddress */
|
||||
USB_ENDPOINT_TYPE_INTERRUPT, /* bmAttributes */
|
||||
WBVAL(0x0010), /* wMaxPacketSize */
|
||||
0x10, /* bInterval */
|
||||
|
||||
|
||||
/* Interface 1, Alternate Setting 0, Data class interface descriptor*/
|
||||
USB_INTERFACE_DESC_SIZE, /* bLength */
|
||||
USB_INTERFACE_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_CDC_DIF_NUM, /* bInterfaceNumber: Number of Interface */
|
||||
0x00, /* bAlternateSetting: no alternate setting */
|
||||
0x02, /* bNumEndpoints: two endpoints used */
|
||||
CDC_DATA_INTERFACE_CLASS, /* bInterfaceClass: Data Interface Class */
|
||||
0x00, /* bInterfaceSubClass: no subclass available */
|
||||
0x00, /* bInterfaceProtocol: no protocol used */
|
||||
0x00, /* iInterface: */
|
||||
/* Endpoint, EP2 Bulk Out */
|
||||
USB_ENDPOINT_DESC_SIZE, /* bLength */
|
||||
USB_ENDPOINT_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_ENDPOINT_OUT(2), /* bEndpointAddress */
|
||||
USB_ENDPOINT_TYPE_BULK, /* bmAttributes */
|
||||
WBVAL(USB_CDC_BUFSIZE), /* wMaxPacketSize */
|
||||
0x00, /* bInterval: ignore for Bulk transfer */
|
||||
/* Endpoint, EP2 Bulk In */
|
||||
USB_ENDPOINT_DESC_SIZE, /* bLength */
|
||||
USB_ENDPOINT_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_ENDPOINT_IN(2), /* bEndpointAddress */
|
||||
USB_ENDPOINT_TYPE_BULK, /* bmAttributes */
|
||||
WBVAL(USB_CDC_BUFSIZE), /* wMaxPacketSize */
|
||||
0x00, /* bInterval: ignore for Bulk transfer */
|
||||
|
||||
|
||||
/* MSC Interface */
|
||||
/* Interface 2, Alternate Setting 0, Data class interface descriptor*/
|
||||
USB_INTERFACE_DESC_SIZE, /* bLength */
|
||||
USB_INTERFACE_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
0x02, /* bInterfaceNumber */
|
||||
0x00, /* bAlternateSetting */
|
||||
0x02, /* bNumEndpoints */
|
||||
USB_DEVICE_CLASS_STORAGE, /* bInterfaceClass */
|
||||
MSC_SUBCLASS_SCSI, /* bInterfaceSubClass */
|
||||
MSC_PROTOCOL_BULK_ONLY, /* bInterfaceProtocol */
|
||||
0x00, /* iInterface */
|
||||
/* Bulk In Endpoint */
|
||||
USB_ENDPOINT_DESC_SIZE, /* bLength */
|
||||
USB_ENDPOINT_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_ENDPOINT_IN(5), /* bEndpointAddress */
|
||||
USB_ENDPOINT_TYPE_BULK, /* bmAttributes */
|
||||
WBVAL(0x0040), /* wMaxPacketSize */
|
||||
0x00, /* bInterval */
|
||||
/* Bulk Out Endpoint */
|
||||
USB_ENDPOINT_DESC_SIZE, /* bLength */
|
||||
USB_ENDPOINT_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
USB_ENDPOINT_OUT(5), /* bEndpointAddress */
|
||||
USB_ENDPOINT_TYPE_BULK, /* bmAttributes */
|
||||
WBVAL(0x0040), /* wMaxPacketSize */
|
||||
0,
|
||||
/* Terminator */
|
||||
0 /* bLength */
|
||||
};
|
||||
|
||||
|
||||
|
||||
|
||||
/* USB String Descriptor (optional) */
|
||||
const uint8_t USB_StringDescriptor[] = {
|
||||
/* Index 0x00: LANGID Codes */
|
||||
0x04, /* bLength */
|
||||
USB_STRING_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
WBVAL(0x0409), /* US English */ /* wLANGID */
|
||||
/* Index 0x01: Manufacturer */
|
||||
(13*2 + 2), /* bLength (13 Char + Type + length) */
|
||||
USB_STRING_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
'm',0,
|
||||
'a',0,
|
||||
'r',0,
|
||||
'l',0,
|
||||
'i',0,
|
||||
'n',0,
|
||||
'f',0,
|
||||
'w',0,
|
||||
'.',0,
|
||||
'o',0,
|
||||
'r',0,
|
||||
'g',0,
|
||||
' ',0,
|
||||
/* Index 0x02: Product */
|
||||
(17*2 + 2), /* bLength ( 17 Char + Type + length) */
|
||||
USB_STRING_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
'M',0,
|
||||
'a',0,
|
||||
'r',0,
|
||||
'l',0,
|
||||
'i',0,
|
||||
'n',0,
|
||||
' ',0,
|
||||
'U',0,
|
||||
'S',0,
|
||||
'B',0,
|
||||
' ',0,
|
||||
'D',0,
|
||||
'e',0,
|
||||
'v',0,
|
||||
'i',0,
|
||||
'c',0,
|
||||
'e',0,
|
||||
/* Index 0x03: Serial Number */
|
||||
(12*2 + 2), /* bLength (12 Char + Type + length) */
|
||||
USB_STRING_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
'1',0,
|
||||
'.',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
'0',0,
|
||||
/* Index 0x04: Interface 0, Alternate Setting 0 */
|
||||
( 4*2 + 2), /* bLength (4 Char + Type + length) */
|
||||
USB_STRING_DESCRIPTOR_TYPE, /* bDescriptorType */
|
||||
'V',0,
|
||||
'C',0,
|
||||
'O',0,
|
||||
'M',0,
|
||||
};
|
|
@ -1,35 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbdesc.h
|
||||
* Purpose: USB Descriptors Definitions
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC microcontroller devices only. Nothing else
|
||||
* gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USBDESC_H__
|
||||
#define __USBDESC_H__
|
||||
|
||||
|
||||
#define WBVAL(x) ((x) & 0xFF),(((x) >> 8) & 0xFF)
|
||||
|
||||
#define USB_DEVICE_DESC_SIZE (sizeof(USB_DEVICE_DESCRIPTOR))
|
||||
#define USB_CONFIGUARTION_DESC_SIZE (sizeof(USB_CONFIGURATION_DESCRIPTOR))
|
||||
#define USB_INTERFACE_DESC_SIZE (sizeof(USB_INTERFACE_DESCRIPTOR))
|
||||
#define USB_ENDPOINT_DESC_SIZE (sizeof(USB_ENDPOINT_DESCRIPTOR))
|
||||
|
||||
extern const uint8_t USB_DeviceDescriptor[];
|
||||
extern const uint8_t USB_ConfigDescriptor[];
|
||||
extern const uint8_t USB_StringDescriptor[];
|
||||
|
||||
|
||||
#endif /* __USBDESC_H__ */
|
|
@ -1,811 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbhw.c
|
||||
* Purpose: USB Hardware Layer Module for NXP's LPC17xx MCU
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*----------------------------------------------------------------------------
|
||||
* History:
|
||||
* V1.20 Added USB_ClearEPBuf
|
||||
* V1.00 Initial Version
|
||||
*----------------------------------------------------------------------------*/
|
||||
extern "C" {
|
||||
#include "LPC17xx.h" /* LPC17xx definitions */
|
||||
}
|
||||
|
||||
#include "usb.h"
|
||||
#include "usbcfg.h"
|
||||
#include "usbreg.h"
|
||||
#include "usbhw.h"
|
||||
#include "usbcore.h"
|
||||
#include "usbuser.h"
|
||||
|
||||
#define EP_MSK_CTRL 0x0001 /* Control Endpoint Logical Address Mask */
|
||||
#define EP_MSK_BULK 0xC924 /* Bulk Endpoint Logical Address Mask */
|
||||
#define EP_MSK_INT 0x4492 /* Interrupt Endpoint Logical Address Mask */
|
||||
#define EP_MSK_ISO 0x1248 /* Isochronous Endpoint Logical Address Mask */
|
||||
|
||||
#if USB_DMA
|
||||
uint32_t UDCA[USB_EP_NUM] __attribute__((section("USB_RAM"))); /* UDCA in USB RAM */
|
||||
uint32_t DD_NISO_Mem[4*DD_NISO_CNT] __attribute__((section("USB_RAM"))); /* Non-Iso DMA Descriptor Memory */
|
||||
uint32_t DD_ISO_Mem [5*DD_ISO_CNT] __attribute__((section("USB_RAM"))); /* Iso DMA Descriptor Memory */
|
||||
uint32_t udca[USB_EP_NUM]; /* UDCA saved values */
|
||||
uint32_t DDMemMap[2];
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* Get Endpoint Physical Address
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: Endpoint Physical Address
|
||||
*/
|
||||
|
||||
uint32_t EPAdr (uint32_t EPNum) {
|
||||
uint32_t val;
|
||||
|
||||
val = (EPNum & 0x0F) << 1;
|
||||
if (EPNum & 0x80) {
|
||||
val += 1;
|
||||
}
|
||||
return (val);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Write Command
|
||||
* Parameters: cmd: Command
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void WrCmd (uint32_t cmd) {
|
||||
|
||||
LPC_USB->USBDevIntClr = CCEMTY_INT;
|
||||
LPC_USB->USBCmdCode = cmd;
|
||||
while ((LPC_USB->USBDevIntSt & CCEMTY_INT) == 0);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Write Command Data
|
||||
* Parameters: cmd: Command
|
||||
* val: Data
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void WrCmdDat (uint32_t cmd, uint32_t val) {
|
||||
|
||||
LPC_USB->USBDevIntClr = CCEMTY_INT;
|
||||
LPC_USB->USBCmdCode = cmd;
|
||||
while ((LPC_USB->USBDevIntSt & CCEMTY_INT) == 0);
|
||||
LPC_USB->USBDevIntClr = CCEMTY_INT;
|
||||
LPC_USB->USBCmdCode = val;
|
||||
while ((LPC_USB->USBDevIntSt & CCEMTY_INT) == 0);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Write Command to Endpoint
|
||||
* Parameters: cmd: Command
|
||||
* val: Data
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void WrCmdEP (uint32_t EPNum, uint32_t cmd){
|
||||
|
||||
LPC_USB->USBDevIntClr = CCEMTY_INT;
|
||||
LPC_USB->USBCmdCode = CMD_SEL_EP(EPAdr(EPNum));
|
||||
while ((LPC_USB->USBDevIntSt & CCEMTY_INT) == 0);
|
||||
LPC_USB->USBDevIntClr = CCEMTY_INT;
|
||||
LPC_USB->USBCmdCode = cmd;
|
||||
while ((LPC_USB->USBDevIntSt & CCEMTY_INT) == 0);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Read Command Data
|
||||
* Parameters: cmd: Command
|
||||
* Return Value: Data Value
|
||||
*/
|
||||
|
||||
uint32_t RdCmdDat (uint32_t cmd) {
|
||||
|
||||
LPC_USB->USBDevIntClr = CCEMTY_INT | CDFULL_INT;
|
||||
LPC_USB->USBCmdCode = cmd;
|
||||
while ((LPC_USB->USBDevIntSt & CDFULL_INT) == 0);
|
||||
return (LPC_USB->USBCmdData);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Initialize Function
|
||||
* Called by the User to initialize USB
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_Init (void) {
|
||||
|
||||
LPC_PINCON->PINSEL1 &= ~((3<<26)|(3<<28)); /* P0.29 D+, P0.30 D- */
|
||||
LPC_PINCON->PINSEL1 |= ((1<<26)|(1<<28)); /* PINSEL1 26.27, 28.29 = 01 */
|
||||
|
||||
//todo: VBUS not used by smoothieboard (though spec requires it for self powered devices), pin used for beeper
|
||||
//todo: Goodlink used for servo4?
|
||||
//LPC_PINCON->PINSEL3 &= ~((3<< 4)|(3<<28)); /* P1.18 GoodLink, P1.30 VBUS */
|
||||
//LPC_PINCON->PINSEL3 |= ((1<< 4)|(2<<28)); /* PINSEL3 4.5 = 01, 28.29 = 10 */
|
||||
|
||||
LPC_PINCON->PINSEL4 &= ~((3<<18) ); /* P2.9 SoftConnect */
|
||||
LPC_PINCON->PINSEL4 |= ((1<<18) ); /* PINSEL4 18.19 = 01 */
|
||||
|
||||
LPC_SC->PCONP |= (1UL<<31); /* USB PCLK -> enable USB Per. */
|
||||
|
||||
LPC_USB->USBClkCtrl = 0x1A; /* Dev, PortSel, AHB clock enable */
|
||||
while ((LPC_USB->USBClkSt & 0x1A) != 0x1A);
|
||||
|
||||
NVIC_EnableIRQ(USB_IRQn); /* enable USB interrupt */
|
||||
|
||||
USB_Reset();
|
||||
USB_SetAddress(0);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Connect Function
|
||||
* Called by the User to Connect/Disconnect USB
|
||||
* Parameters: con: Connect/Disconnect
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_Connect (uint32_t con) {
|
||||
WrCmdDat(CMD_SET_DEV_STAT, DAT_WR_BYTE(con ? DEV_CON : 0));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Reset Function
|
||||
* Called automatically on USB Reset
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_Reset (void) {
|
||||
#if USB_DMA
|
||||
uint32_t n;
|
||||
#endif
|
||||
|
||||
LPC_USB->USBEpInd = 0;
|
||||
LPC_USB->USBMaxPSize = USB_MAX_PACKET0;
|
||||
LPC_USB->USBEpInd = 1;
|
||||
LPC_USB->USBMaxPSize = USB_MAX_PACKET0;
|
||||
while ((LPC_USB->USBDevIntSt & EP_RLZED_INT) == 0);
|
||||
|
||||
LPC_USB->USBEpIntClr = 0xFFFFFFFF;
|
||||
LPC_USB->USBEpIntEn = 0xFFFFFFFF ^ USB_DMA_EP;
|
||||
LPC_USB->USBDevIntClr = 0xFFFFFFFF;
|
||||
LPC_USB->USBDevIntEn = DEV_STAT_INT | EP_SLOW_INT |
|
||||
(USB_SOF_EVENT ? FRAME_INT : 0) |
|
||||
(USB_ERROR_EVENT ? ERR_INT : 0);
|
||||
|
||||
WrCmdDat(CMD_SET_MODE, DAT_WR_BYTE(INAK_BI));
|
||||
|
||||
|
||||
#if USB_DMA
|
||||
LPC_USB->USBUDCAH = USB_RAM_ADR;
|
||||
LPC_USB->USBDMARClr = 0xFFFFFFFF;
|
||||
LPC_USB->USBEpDMADis = 0xFFFFFFFF;
|
||||
LPC_USB->USBEpDMAEn = USB_DMA_EP;
|
||||
LPC_USB->USBEoTIntClr = 0xFFFFFFFF;
|
||||
LPC_USB->USBNDDRIntClr = 0xFFFFFFFF;
|
||||
LPC_USB->USBSysErrIntClr = 0xFFFFFFFF;
|
||||
LPC_USB->USBDMAIntEn = 0x00000007;
|
||||
DDMemMap[0] = 0x00000000;
|
||||
DDMemMap[1] = 0x00000000;
|
||||
for (n = 0; n < USB_EP_NUM; n++) {
|
||||
udca[n] = 0;
|
||||
UDCA[n] = 0;
|
||||
}
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Suspend Function
|
||||
* Called automatically on USB Suspend
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_Suspend (void) {
|
||||
/* Performed by Hardware */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Resume Function
|
||||
* Called automatically on USB Resume
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_Resume (void) {
|
||||
/* Performed by Hardware */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Remote Wakeup Function
|
||||
* Called automatically on USB Remote Wakeup
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_WakeUp (void) {
|
||||
|
||||
if (USB_DeviceStatus & USB_GETSTATUS_REMOTE_WAKEUP) {
|
||||
WrCmdDat(CMD_SET_DEV_STAT, DAT_WR_BYTE(DEV_CON));
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Remote Wakeup Configuration Function
|
||||
* Parameters: cfg: Enable/Disable
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_WakeUpCfg (uint32_t cfg) {
|
||||
/* Not needed */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Set Address Function
|
||||
* Parameters: adr: USB Address
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_SetAddress (uint32_t adr) {
|
||||
WrCmdDat(CMD_SET_ADDR, DAT_WR_BYTE(DEV_EN | adr)); /* Don't wait for next */
|
||||
WrCmdDat(CMD_SET_ADDR, DAT_WR_BYTE(DEV_EN | adr)); /* Setup Status Phase */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Configure Function
|
||||
* Parameters: cfg: Configure/Deconfigure
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_Configure (uint32_t cfg) {
|
||||
|
||||
WrCmdDat(CMD_CFG_DEV, DAT_WR_BYTE(cfg ? CONF_DVICE : 0));
|
||||
|
||||
LPC_USB->USBReEp = 0x00000003;
|
||||
while ((LPC_USB->USBDevIntSt & EP_RLZED_INT) == 0);
|
||||
LPC_USB->USBDevIntClr = EP_RLZED_INT;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Configure USB Endpoint according to Descriptor
|
||||
* Parameters: pEPD: Pointer to Endpoint Descriptor
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_ConfigEP (USB_ENDPOINT_DESCRIPTOR *pEPD) {
|
||||
uint32_t num;
|
||||
|
||||
num = EPAdr(pEPD->bEndpointAddress);
|
||||
LPC_USB->USBReEp |= (1 << num);
|
||||
LPC_USB->USBEpInd = num;
|
||||
LPC_USB->USBMaxPSize = pEPD->wMaxPacketSize;
|
||||
while ((LPC_USB->USBDevIntSt & EP_RLZED_INT) == 0);
|
||||
LPC_USB->USBDevIntClr = EP_RLZED_INT;
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Set Direction for USB Control Endpoint
|
||||
* Parameters: dir: Out (dir == 0), In (dir <> 0)
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_DirCtrlEP (uint32_t dir) {
|
||||
/* Not needed */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Enable USB Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_EnableEP (uint32_t EPNum) {
|
||||
WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(0));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Disable USB Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_DisableEP (uint32_t EPNum) {
|
||||
WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(EP_STAT_DA));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Reset USB Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_ResetEP (uint32_t EPNum) {
|
||||
WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(0));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Set Stall for USB Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_SetStallEP (uint32_t EPNum) {
|
||||
WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(EP_STAT_ST));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Clear Stall for USB Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_ClrStallEP (uint32_t EPNum) {
|
||||
WrCmdDat(CMD_SET_EP_STAT(EPAdr(EPNum)), DAT_WR_BYTE(0));
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Clear USB Endpoint Buffer
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_ClearEPBuf (uint32_t EPNum) {
|
||||
WrCmdEP(EPNum, CMD_CLR_BUF);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Read USB Endpoint Data
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* pData: Pointer to Data Buffer
|
||||
* Return Value: Number of bytes read
|
||||
*/
|
||||
|
||||
uint32_t USB_ReadEP (uint32_t EPNum, uint8_t *pData) {
|
||||
uint32_t cnt, n;
|
||||
|
||||
LPC_USB->USBCtrl = ((EPNum & 0x0F) << 2) | CTRL_RD_EN;
|
||||
|
||||
do {
|
||||
cnt = LPC_USB->USBRxPLen;
|
||||
} while ((cnt & PKT_RDY) == 0);
|
||||
cnt &= PKT_LNGTH_MASK;
|
||||
|
||||
for (n = 0; n < (cnt + 3) / 4; n++) {
|
||||
*((__packed uint32_t *)pData) = LPC_USB->USBRxData;
|
||||
pData += 4;
|
||||
}
|
||||
LPC_USB->USBCtrl = 0;
|
||||
|
||||
if (((EP_MSK_ISO >> EPNum) & 1) == 0) { /* Non-Isochronous Endpoint */
|
||||
WrCmdEP(EPNum, CMD_CLR_BUF);
|
||||
}
|
||||
|
||||
return (cnt);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Write USB Endpoint Data
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* pData: Pointer to Data Buffer
|
||||
* cnt: Number of bytes to write
|
||||
* Return Value: Number of bytes written
|
||||
*/
|
||||
|
||||
uint32_t USB_WriteEP (uint32_t EPNum, uint8_t *pData, uint32_t cnt) {
|
||||
uint32_t n;
|
||||
|
||||
LPC_USB->USBCtrl = ((EPNum & 0x0F) << 2) | CTRL_WR_EN;
|
||||
|
||||
LPC_USB->USBTxPLen = cnt;
|
||||
|
||||
for (n = 0; n < (cnt + 3) / 4; n++) {
|
||||
LPC_USB->USBTxData = *((__packed uint32_t *)pData);
|
||||
pData += 4;
|
||||
}
|
||||
LPC_USB->USBCtrl = 0;
|
||||
WrCmdEP(EPNum, CMD_VALID_BUF);
|
||||
return (cnt);
|
||||
}
|
||||
|
||||
#if USB_DMA
|
||||
|
||||
/* DMA Descriptor Memory Layout */
|
||||
const uint32_t DDAdr[2] = { DD_NISO_ADR, DD_ISO_ADR };
|
||||
const uint32_t DDSz [2] = { 16, 20 };
|
||||
|
||||
|
||||
/*
|
||||
* Setup USB DMA Transfer for selected Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* pDD: Pointer to DMA Descriptor
|
||||
* Return Value: TRUE - Success, FALSE - Error
|
||||
*/
|
||||
|
||||
uint32_t USB_DMA_Setup(uint32_t EPNum, USB_DMA_DESCRIPTOR *pDD) {
|
||||
uint32_t num, ptr, nxt, iso, n;
|
||||
|
||||
iso = pDD->Cfg.Type.IsoEP; /* Iso or Non-Iso Descriptor */
|
||||
num = EPAdr(EPNum); /* Endpoint's Physical Address */
|
||||
|
||||
ptr = 0; /* Current Descriptor */
|
||||
nxt = udca[num]; /* Initial Descriptor */
|
||||
while (nxt) { /* Go through Descriptor List */
|
||||
ptr = nxt; /* Current Descriptor */
|
||||
if (!pDD->Cfg.Type.Link) { /* Check for Linked Descriptors */
|
||||
n = (ptr - DDAdr[iso]) / DDSz[iso]; /* Descriptor Index */
|
||||
DDMemMap[iso] &= ~(1 << n); /* Unmark Memory Usage */
|
||||
}
|
||||
nxt = *((uint32_t *)ptr); /* Next Descriptor */
|
||||
}
|
||||
|
||||
for (n = 0; n < 32; n++) { /* Search for available Memory */
|
||||
if ((DDMemMap[iso] & (1 << n)) == 0) {
|
||||
break; /* Memory found */
|
||||
}
|
||||
}
|
||||
if (n == 32) return (FALSE); /* Memory not available */
|
||||
|
||||
DDMemMap[iso] |= 1 << n; /* Mark Memory Usage */
|
||||
nxt = DDAdr[iso] + n * DDSz[iso]; /* Next Descriptor */
|
||||
|
||||
if (ptr && pDD->Cfg.Type.Link) {
|
||||
*((uint32_t *)(ptr + 0)) = nxt; /* Link in new Descriptor */
|
||||
*((uint32_t *)(ptr + 4)) |= 0x00000004; /* Next DD is Valid */
|
||||
} else {
|
||||
udca[num] = nxt; /* Save new Descriptor */
|
||||
UDCA[num] = nxt; /* Update UDCA in USB */
|
||||
}
|
||||
|
||||
uint32_t * nxt_ptr = (uint32_t *)nxt;
|
||||
/* Fill in DMA Descriptor */
|
||||
*nxt_ptr++ = 0; /* Next DD Pointer */
|
||||
*nxt_ptr++ = (pDD->Cfg.Type.ATLE) |
|
||||
(pDD->Cfg.Type.IsoEP << 4) |
|
||||
(pDD->MaxSize << 5) |
|
||||
(pDD->BufLen << 16);
|
||||
*nxt_ptr++ = pDD->BufAdr;
|
||||
*nxt_ptr++ = pDD->Cfg.Type.LenPos << 8;
|
||||
if (iso) {
|
||||
*nxt_ptr = pDD->InfoAdr;
|
||||
}
|
||||
|
||||
return (TRUE); /* Success */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Enable USB DMA Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_DMA_Enable (uint32_t EPNum) {
|
||||
LPC_USB->USBEpDMAEn = 1 << EPAdr(EPNum);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Disable USB DMA Endpoint
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: None
|
||||
*/
|
||||
|
||||
void USB_DMA_Disable (uint32_t EPNum) {
|
||||
LPC_USB->USBEpDMADis = 1 << EPAdr(EPNum);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Get USB DMA Endpoint Status
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: DMA Status
|
||||
*/
|
||||
|
||||
uint32_t USB_DMA_Status (uint32_t EPNum) {
|
||||
uint32_t ptr, val;
|
||||
|
||||
ptr = UDCA[EPAdr(EPNum)]; /* Current Descriptor */
|
||||
if (ptr == 0)
|
||||
return (USB_DMA_INVALID);
|
||||
|
||||
val = *((uint32_t *)(ptr + 3*4)); /* Status Information */
|
||||
switch ((val >> 1) & 0x0F) {
|
||||
case 0x00: /* Not serviced */
|
||||
return (USB_DMA_IDLE);
|
||||
case 0x01: /* Being serviced */
|
||||
return (USB_DMA_BUSY);
|
||||
case 0x02: /* Normal Completition */
|
||||
return (USB_DMA_DONE);
|
||||
case 0x03: /* Data Under Run */
|
||||
return (USB_DMA_UNDER_RUN);
|
||||
case 0x08: /* Data Over Run */
|
||||
return (USB_DMA_OVER_RUN);
|
||||
case 0x09: /* System Error */
|
||||
return (USB_DMA_ERROR);
|
||||
}
|
||||
|
||||
return (USB_DMA_UNKNOWN);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Get USB DMA Endpoint Current Buffer Address
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: DMA Address (or -1 when DMA is Invalid)
|
||||
*/
|
||||
|
||||
uint32_t USB_DMA_BufAdr (uint32_t EPNum) {
|
||||
uint32_t ptr, val;
|
||||
|
||||
ptr = UDCA[EPAdr(EPNum)]; /* Current Descriptor */
|
||||
if (ptr == 0)
|
||||
{
|
||||
return ((uint32_t)(-1)); /* DMA Invalid */
|
||||
}
|
||||
|
||||
val = *((uint32_t *)(ptr + 2*4)); /* Buffer Address */
|
||||
return (val); /* Current Address */
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Get USB DMA Endpoint Current Buffer Count
|
||||
* Number of transfered Bytes or Iso Packets
|
||||
* Parameters: EPNum: Endpoint Number
|
||||
* EPNum.0..3: Address
|
||||
* EPNum.7: Dir
|
||||
* Return Value: DMA Count (or -1 when DMA is Invalid)
|
||||
*/
|
||||
|
||||
uint32_t USB_DMA_BufCnt (uint32_t EPNum) {
|
||||
uint32_t ptr, val;
|
||||
|
||||
ptr = UDCA[EPAdr(EPNum)]; /* Current Descriptor */
|
||||
if (ptr == 0)
|
||||
{
|
||||
return ((uint32_t)(-1)); /* DMA Invalid */
|
||||
}
|
||||
val = *((uint32_t *)(ptr + 3*4)); /* Status Information */
|
||||
return (val >> 16); /* Current Count */
|
||||
}
|
||||
|
||||
|
||||
#endif /* USB_DMA */
|
||||
|
||||
|
||||
/*
|
||||
* Get USB Last Frame Number
|
||||
* Parameters: None
|
||||
* Return Value: Frame Number
|
||||
*/
|
||||
|
||||
uint32_t USB_GetFrame (void) {
|
||||
uint32_t val;
|
||||
|
||||
WrCmd(CMD_RD_FRAME);
|
||||
val = RdCmdDat(DAT_RD_FRAME);
|
||||
val = val | (RdCmdDat(DAT_RD_FRAME) << 8);
|
||||
|
||||
return (val);
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Interrupt Service Routine
|
||||
*/
|
||||
|
||||
void USB_IRQHandler (void) {
|
||||
uint32_t disr, val, n, m;
|
||||
uint32_t episr, episrCur;
|
||||
|
||||
disr = LPC_USB->USBDevIntSt; /* Device Interrupt Status */
|
||||
|
||||
/* Device Status Interrupt (Reset, Connect change, Suspend/Resume) */
|
||||
if (disr & DEV_STAT_INT) {
|
||||
LPC_USB->USBDevIntClr = DEV_STAT_INT;
|
||||
WrCmd(CMD_GET_DEV_STAT);
|
||||
val = RdCmdDat(DAT_GET_DEV_STAT); /* Device Status */
|
||||
if (val & DEV_RST) { /* Reset */
|
||||
USB_Reset();
|
||||
#if USB_RESET_EVENT
|
||||
USB_Reset_Event();
|
||||
#endif
|
||||
}
|
||||
if (val & DEV_CON_CH) { /* Connect change */
|
||||
#if USB_POWER_EVENT
|
||||
USB_Power_Event(val & DEV_CON);
|
||||
#endif
|
||||
}
|
||||
if (val & DEV_SUS_CH) { /* Suspend/Resume */
|
||||
if (val & DEV_SUS) { /* Suspend */
|
||||
USB_Suspend();
|
||||
#if USB_SUSPEND_EVENT
|
||||
USB_Suspend_Event();
|
||||
#endif
|
||||
} else { /* Resume */
|
||||
USB_Resume();
|
||||
#if USB_RESUME_EVENT
|
||||
USB_Resume_Event();
|
||||
#endif
|
||||
}
|
||||
}
|
||||
goto isr_end;
|
||||
}
|
||||
|
||||
#if USB_SOF_EVENT
|
||||
/* Start of Frame Interrupt */
|
||||
if (disr & FRAME_INT) {
|
||||
LPC_USB->USBDevIntClr = FRAME_INT;
|
||||
USB_SOF_Event();
|
||||
}
|
||||
#endif
|
||||
|
||||
#if USB_ERROR_EVENT
|
||||
/* Error Interrupt */
|
||||
if (disr & ERR_INT) {
|
||||
LPC_USB->USBDevIntClr = ERR_INT;
|
||||
WrCmd(CMD_RD_ERR_STAT);
|
||||
val = RdCmdDat(DAT_RD_ERR_STAT);
|
||||
USB_Error_Event(val);
|
||||
}
|
||||
#endif
|
||||
|
||||
/* Endpoint's Slow Interrupt */
|
||||
if (disr & EP_SLOW_INT) {
|
||||
episrCur = 0;
|
||||
episr = LPC_USB->USBEpIntSt;
|
||||
for (n = 0; n < USB_EP_NUM; n++) { /* Check All Endpoints */
|
||||
if (episr == episrCur) break; /* break if all EP interrupts handled */
|
||||
if (episr & (1 << n)) {
|
||||
episrCur |= (1 << n);
|
||||
m = n >> 1;
|
||||
|
||||
LPC_USB->USBEpIntClr = (1 << n);
|
||||
while ((LPC_USB->USBDevIntSt & CDFULL_INT) == 0);
|
||||
val = LPC_USB->USBCmdData;
|
||||
|
||||
if ((n & 1) == 0) { /* OUT Endpoint */
|
||||
if (n == 0) { /* Control OUT Endpoint */
|
||||
if (val & EP_SEL_STP) { /* Setup Packet */
|
||||
if (USB_P_EP[0]) {
|
||||
USB_P_EP[0](USB_EVT_SETUP);
|
||||
continue;
|
||||
}
|
||||
}
|
||||
}
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_OUT);
|
||||
}
|
||||
} else { /* IN Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_IN);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
LPC_USB->USBDevIntClr = EP_SLOW_INT;
|
||||
}
|
||||
|
||||
#if USB_DMA
|
||||
|
||||
if (LPC_USB->USBDMAIntSt & 0x00000001) { /* End of Transfer Interrupt */
|
||||
val = LPC_USB->USBEoTIntSt;
|
||||
for (n = 2; n < USB_EP_NUM; n++) { /* Check All Endpoints */
|
||||
if (val & (1 << n)) {
|
||||
m = n >> 1;
|
||||
if ((n & 1) == 0) { /* OUT Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_OUT_DMA_EOT);
|
||||
}
|
||||
} else { /* IN Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_IN_DMA_EOT);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
LPC_USB->USBEoTIntClr = val;
|
||||
}
|
||||
|
||||
if (LPC_USB->USBDMAIntSt & 0x00000002) { /* New DD Request Interrupt */
|
||||
val = LPC_USB->USBNDDRIntSt;
|
||||
for (n = 2; n < USB_EP_NUM; n++) { /* Check All Endpoints */
|
||||
if (val & (1 << n)) {
|
||||
m = n >> 1;
|
||||
if ((n & 1) == 0) { /* OUT Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_OUT_DMA_NDR);
|
||||
}
|
||||
} else { /* IN Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_IN_DMA_NDR);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
LPC_USB->USBNDDRIntClr = val;
|
||||
}
|
||||
|
||||
if (LPC_USB->USBDMAIntSt & 0x00000004) { /* System Error Interrupt */
|
||||
val = LPC_USB->USBSysErrIntSt;
|
||||
for (n = 2; n < USB_EP_NUM; n++) { /* Check All Endpoints */
|
||||
if (val & (1 << n)) {
|
||||
m = n >> 1;
|
||||
if ((n & 1) == 0) { /* OUT Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_OUT_DMA_ERR);
|
||||
}
|
||||
} else { /* IN Endpoint */
|
||||
if (USB_P_EP[m]) {
|
||||
USB_P_EP[m](USB_EVT_IN_DMA_ERR);
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
LPC_USB->USBSysErrIntClr = val;
|
||||
}
|
||||
|
||||
#endif /* USB_DMA */
|
||||
|
||||
isr_end:
|
||||
return;
|
||||
}
|
|
@ -1,114 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbhw.h
|
||||
* Purpose: USB Hardware Layer Definitions
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*----------------------------------------------------------------------------
|
||||
* History:
|
||||
* V1.20 Added USB_ClearEPBuf
|
||||
* V1.00 Initial Version
|
||||
*----------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USBHW_H__
|
||||
#define __USBHW_H__
|
||||
extern "C" {
|
||||
#include "lpc_types.h"
|
||||
}
|
||||
/* USB RAM Definitions */
|
||||
#define USB_RAM_ADR 0x2007C000 /* USB RAM Start Address */
|
||||
#define USB_RAM_SZ 0x00004000 /* USB RAM Size (16kB) */
|
||||
|
||||
/* DMA Endpoint Descriptors */
|
||||
#define DD_NISO_CNT 16 /* Non-Iso EP DMA Descr. Count (max. 32) */
|
||||
#define DD_ISO_CNT 8 /* Iso EP DMA Descriptor Count (max. 32) */
|
||||
#define DD_NISO_SZ (DD_NISO_CNT * 16) /* Non-Iso DMA Descr. Size */
|
||||
#define DD_ISO_SZ (DD_ISO_CNT * 20) /* Iso DMA Descriptor Size */
|
||||
#define DD_NISO_ADR (USB_RAM_ADR + 128) /* Non-Iso DMA Descr. Address */
|
||||
#define DD_ISO_ADR (DD_NISO_ADR + DD_NISO_SZ) /* Iso DMA Descr. Address */
|
||||
#define DD_SZ (128 + DD_NISO_SZ + DD_ISO_SZ) /* Descr. Size */
|
||||
|
||||
/* DMA Buffer Memory Definitions */
|
||||
#define DMA_BUF_ADR (USB_RAM_ADR + DD_SZ) /* DMA Buffer Start Address */
|
||||
#define DMA_BUF_SZ (USB_RAM_SZ - DD_SZ) /* DMA Buffer Size */
|
||||
|
||||
/* USB Error Codes */
|
||||
#define USB_ERR_PID 0x0001 /* PID Error */
|
||||
#define USB_ERR_UEPKT 0x0002 /* Unexpected Packet */
|
||||
#define USB_ERR_DCRC 0x0004 /* Data CRC Error */
|
||||
#define USB_ERR_TIMOUT 0x0008 /* Bus Time-out Error */
|
||||
#define USB_ERR_EOP 0x0010 /* End of Packet Error */
|
||||
#define USB_ERR_B_OVRN 0x0020 /* Buffer Overrun */
|
||||
#define USB_ERR_BTSTF 0x0040 /* Bit Stuff Error */
|
||||
#define USB_ERR_TGL 0x0080 /* Toggle Bit Error */
|
||||
|
||||
/* USB DMA Status Codes */
|
||||
#define USB_DMA_INVALID 0x0000 /* DMA Invalid - Not Configured */
|
||||
#define USB_DMA_IDLE 0x0001 /* DMA Idle - Waiting for Trigger */
|
||||
#define USB_DMA_BUSY 0x0002 /* DMA Busy - Transfer in progress */
|
||||
#define USB_DMA_DONE 0x0003 /* DMA Transfer Done (no Errors)*/
|
||||
#define USB_DMA_OVER_RUN 0x0004 /* Data Over Run */
|
||||
#define USB_DMA_UNDER_RUN 0x0005 /* Data Under Run (Short Packet) */
|
||||
#define USB_DMA_ERROR 0x0006 /* Error */
|
||||
#define USB_DMA_UNKNOWN 0xFFFF /* Unknown State */
|
||||
|
||||
/* USB DMA Descriptor */
|
||||
typedef struct _USB_DMA_DESCRIPTOR {
|
||||
uint32_t BufAdr; /* DMA Buffer Address */
|
||||
uint16_t BufLen; /* DMA Buffer Length */
|
||||
uint16_t MaxSize; /* Maximum Packet Size */
|
||||
uint32_t InfoAdr; /* Packet Info Memory Address */
|
||||
union { /* DMA Configuration */
|
||||
struct {
|
||||
uint32_t Link : 1; /* Link to existing Descriptors */
|
||||
uint32_t IsoEP : 1; /* Isonchronous Endpoint */
|
||||
uint32_t ATLE : 1; /* ATLE (Auto Transfer Length Extract) */
|
||||
uint32_t Rsrvd : 5; /* Reserved */
|
||||
uint32_t LenPos : 8; /* Length Position (ATLE) */
|
||||
} Type;
|
||||
uint32_t Val;
|
||||
} Cfg;
|
||||
} USB_DMA_DESCRIPTOR;
|
||||
|
||||
extern "C" {
|
||||
/* USB Hardware Functions */
|
||||
extern void USB_Init (void);
|
||||
extern void USB_Connect (uint32_t con);
|
||||
extern void USB_Reset (void);
|
||||
extern void USB_Suspend (void);
|
||||
extern void USB_Resume (void);
|
||||
extern void USB_WakeUp (void);
|
||||
extern void USB_WakeUpCfg (uint32_t cfg);
|
||||
extern void USB_SetAddress (uint32_t adr);
|
||||
extern void USB_Configure (uint32_t cfg);
|
||||
extern void USB_ConfigEP (USB_ENDPOINT_DESCRIPTOR *pEPD);
|
||||
extern void USB_DirCtrlEP (uint32_t dir);
|
||||
extern void USB_EnableEP (uint32_t EPNum);
|
||||
extern void USB_DisableEP (uint32_t EPNum);
|
||||
extern void USB_ResetEP (uint32_t EPNum);
|
||||
extern void USB_SetStallEP (uint32_t EPNum);
|
||||
extern void USB_ClrStallEP (uint32_t EPNum);
|
||||
extern void USB_ClearEPBuf (uint32_t EPNum);
|
||||
extern uint32_t USB_ReadEP (uint32_t EPNum, uint8_t *pData);
|
||||
extern uint32_t USB_WriteEP (uint32_t EPNum, uint8_t *pData, uint32_t cnt);
|
||||
extern uint32_t USB_DMA_Setup (uint32_t EPNum, USB_DMA_DESCRIPTOR *pDD);
|
||||
extern void USB_DMA_Enable (uint32_t EPNum);
|
||||
extern void USB_DMA_Disable(uint32_t EPNum);
|
||||
extern uint32_t USB_DMA_Status (uint32_t EPNum);
|
||||
extern uint32_t USB_DMA_BufAdr (uint32_t EPNum);
|
||||
extern uint32_t USB_DMA_BufCnt (uint32_t EPNum);
|
||||
extern uint32_t USB_GetFrame (void);
|
||||
extern void USB_IRQHandler (void);
|
||||
}
|
||||
|
||||
#endif /* __USBHW_H__ */
|
|
@ -1,130 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbreg.h
|
||||
* Purpose: USB Hardware Layer Definitions for NXP LPC Family MCUs
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USBREG_H
|
||||
#define __USBREG_H
|
||||
|
||||
/* Device Interrupt Bit Definitions */
|
||||
#define FRAME_INT 0x00000001
|
||||
#define EP_FAST_INT 0x00000002
|
||||
#define EP_SLOW_INT 0x00000004
|
||||
#define DEV_STAT_INT 0x00000008
|
||||
#define CCEMTY_INT 0x00000010
|
||||
#define CDFULL_INT 0x00000020
|
||||
#define RxENDPKT_INT 0x00000040
|
||||
#define TxENDPKT_INT 0x00000080
|
||||
#define EP_RLZED_INT 0x00000100
|
||||
#define ERR_INT 0x00000200
|
||||
|
||||
/* Rx & Tx Packet Length Definitions */
|
||||
#define PKT_LNGTH_MASK 0x000003FF
|
||||
#define PKT_DV 0x00000400
|
||||
#define PKT_RDY 0x00000800
|
||||
|
||||
/* USB Control Definitions */
|
||||
#define CTRL_RD_EN 0x00000001
|
||||
#define CTRL_WR_EN 0x00000002
|
||||
|
||||
/* Command Codes */
|
||||
#define CMD_SET_ADDR 0x00D00500
|
||||
#define CMD_CFG_DEV 0x00D80500
|
||||
#define CMD_SET_MODE 0x00F30500
|
||||
#define CMD_RD_FRAME 0x00F50500
|
||||
#define DAT_RD_FRAME 0x00F50200
|
||||
#define CMD_RD_TEST 0x00FD0500
|
||||
#define DAT_RD_TEST 0x00FD0200
|
||||
#define CMD_SET_DEV_STAT 0x00FE0500
|
||||
#define CMD_GET_DEV_STAT 0x00FE0500
|
||||
#define DAT_GET_DEV_STAT 0x00FE0200
|
||||
#define CMD_GET_ERR_CODE 0x00FF0500
|
||||
#define DAT_GET_ERR_CODE 0x00FF0200
|
||||
#define CMD_RD_ERR_STAT 0x00FB0500
|
||||
#define DAT_RD_ERR_STAT 0x00FB0200
|
||||
#define DAT_WR_BYTE(x) (0x00000100 | ((x) << 16))
|
||||
#define CMD_SEL_EP(x) (0x00000500 | ((x) << 16))
|
||||
#define DAT_SEL_EP(x) (0x00000200 | ((x) << 16))
|
||||
#define CMD_SEL_EP_CLRI(x) (0x00400500 | ((x) << 16))
|
||||
#define DAT_SEL_EP_CLRI(x) (0x00400200 | ((x) << 16))
|
||||
#define CMD_SET_EP_STAT(x) (0x00400500 | ((x) << 16))
|
||||
#define CMD_CLR_BUF 0x00F20500
|
||||
#define DAT_CLR_BUF 0x00F20200
|
||||
#define CMD_VALID_BUF 0x00FA0500
|
||||
|
||||
/* Device Address Register Definitions */
|
||||
#define DEV_ADDR_MASK 0x7F
|
||||
#define DEV_EN 0x80
|
||||
|
||||
/* Device Configure Register Definitions */
|
||||
#define CONF_DVICE 0x01
|
||||
|
||||
/* Device Mode Register Definitions */
|
||||
#define AP_CLK 0x01
|
||||
#define INAK_CI 0x02
|
||||
#define INAK_CO 0x04
|
||||
#define INAK_II 0x08
|
||||
#define INAK_IO 0x10
|
||||
#define INAK_BI 0x20
|
||||
#define INAK_BO 0x40
|
||||
|
||||
/* Device Status Register Definitions */
|
||||
#define DEV_CON 0x01
|
||||
#define DEV_CON_CH 0x02
|
||||
#define DEV_SUS 0x04
|
||||
#define DEV_SUS_CH 0x08
|
||||
#define DEV_RST 0x10
|
||||
|
||||
/* Error Code Register Definitions */
|
||||
#define ERR_EC_MASK 0x0F
|
||||
#define ERR_EA 0x10
|
||||
|
||||
/* Error Status Register Definitions */
|
||||
#define ERR_PID 0x01
|
||||
#define ERR_UEPKT 0x02
|
||||
#define ERR_DCRC 0x04
|
||||
#define ERR_TIMOUT 0x08
|
||||
#define ERR_EOP 0x10
|
||||
#define ERR_B_OVRN 0x20
|
||||
#define ERR_BTSTF 0x40
|
||||
#define ERR_TGL 0x80
|
||||
|
||||
/* Endpoint Select Register Definitions */
|
||||
#define EP_SEL_F 0x01
|
||||
#define EP_SEL_ST 0x02
|
||||
#define EP_SEL_STP 0x04
|
||||
#define EP_SEL_PO 0x08
|
||||
#define EP_SEL_EPN 0x10
|
||||
#define EP_SEL_B_1_FULL 0x20
|
||||
#define EP_SEL_B_2_FULL 0x40
|
||||
|
||||
/* Endpoint Status Register Definitions */
|
||||
#define EP_STAT_ST 0x01
|
||||
#define EP_STAT_DA 0x20
|
||||
#define EP_STAT_RF_MO 0x40
|
||||
#define EP_STAT_CND_ST 0x80
|
||||
|
||||
/* Clear Buffer Register Definitions */
|
||||
#define CLR_BUF_PO 0x01
|
||||
|
||||
|
||||
/* DMA Interrupt Bit Definitions */
|
||||
#define EOT_INT 0x01
|
||||
#define NDD_REQ_INT 0x02
|
||||
#define SYS_ERR_INT 0x04
|
||||
|
||||
|
||||
#endif /* __USBREG_H */
|
|
@ -1,353 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbuser.c
|
||||
* Purpose: USB Custom User Module
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
extern "C" {
|
||||
#include "lpc_types.h"
|
||||
#include <debug_frmwrk.h>
|
||||
}
|
||||
|
||||
#include "usb.h"
|
||||
#include "usbcfg.h"
|
||||
#include "usbhw.h"
|
||||
#include "usbcore.h"
|
||||
#include "usbuser.h"
|
||||
#include "cdcuser.h"
|
||||
#include "mscuser.h"
|
||||
|
||||
|
||||
/*
|
||||
* USB Power Event Callback
|
||||
* Called automatically on USB Power Event
|
||||
* Parameter: power: On(TRUE)/Off(FALSE)
|
||||
*/
|
||||
|
||||
#if USB_POWER_EVENT
|
||||
void USB_Power_Event (uint32_t power) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Reset Event Callback
|
||||
* Called automatically on USB Reset Event
|
||||
*/
|
||||
|
||||
#if USB_RESET_EVENT
|
||||
void USB_Reset_Event (void) {
|
||||
USB_ResetCore();
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Suspend Event Callback
|
||||
* Called automatically on USB Suspend Event
|
||||
*/
|
||||
|
||||
#if USB_SUSPEND_EVENT
|
||||
void USB_Suspend_Event (void) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Resume Event Callback
|
||||
* Called automatically on USB Resume Event
|
||||
*/
|
||||
|
||||
#if USB_RESUME_EVENT
|
||||
void USB_Resume_Event (void) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Remote Wakeup Event Callback
|
||||
* Called automatically on USB Remote Wakeup Event
|
||||
*/
|
||||
|
||||
#if USB_WAKEUP_EVENT
|
||||
void USB_WakeUp_Event (void) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Start of Frame Event Callback
|
||||
* Called automatically on USB Start of Frame Event
|
||||
*/
|
||||
|
||||
#if USB_SOF_EVENT
|
||||
void USB_SOF_Event (void) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Error Event Callback
|
||||
* Called automatically on USB Error Event
|
||||
* Parameter: error: Error Code
|
||||
*/
|
||||
|
||||
#if USB_ERROR_EVENT
|
||||
void USB_Error_Event (uint32_t error) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Set Configuration Event Callback
|
||||
* Called automatically on USB Set Configuration Request
|
||||
*/
|
||||
|
||||
#if USB_CONFIGURE_EVENT
|
||||
void USB_Configure_Event (void) {
|
||||
|
||||
if (USB_Configuration) { /* Check if USB is configured */
|
||||
/* add your code here */
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Set Interface Event Callback
|
||||
* Called automatically on USB Set Interface Request
|
||||
*/
|
||||
|
||||
#if USB_INTERFACE_EVENT
|
||||
void USB_Interface_Event (void) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
/*
|
||||
* USB Set/Clear Feature Event Callback
|
||||
* Called automatically on USB Set/Clear Feature Request
|
||||
*/
|
||||
|
||||
#if USB_FEATURE_EVENT
|
||||
void USB_Feature_Event (void) {
|
||||
}
|
||||
#endif
|
||||
|
||||
|
||||
#define P_EP(n) ((USB_EP_EVENT & (1 << (n))) ? USB_EndPoint##n : nullptr)
|
||||
|
||||
/* USB Endpoint Events Callback Pointers */
|
||||
void (* const USB_P_EP[16]) (uint32_t event) = {
|
||||
P_EP(0),
|
||||
P_EP(1),
|
||||
P_EP(2),
|
||||
P_EP(3),
|
||||
P_EP(4),
|
||||
P_EP(5),
|
||||
P_EP(6),
|
||||
P_EP(7),
|
||||
P_EP(8),
|
||||
P_EP(9),
|
||||
P_EP(10),
|
||||
P_EP(11),
|
||||
P_EP(12),
|
||||
P_EP(13),
|
||||
P_EP(14),
|
||||
P_EP(15),
|
||||
};
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 1 Event Callback
|
||||
* Called automatically on USB Endpoint 1 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint1 (uint32_t event) {
|
||||
uint16_t temp;
|
||||
static uint16_t serialState;
|
||||
|
||||
switch (event) {
|
||||
case USB_EVT_IN:
|
||||
temp = CDC_GetSerialState();
|
||||
if (serialState != temp) {
|
||||
serialState = temp;
|
||||
CDC_NotificationIn(); /* send SERIAL_STATE notification */
|
||||
}
|
||||
break;
|
||||
default:
|
||||
_DBG("Unhandled EP1 event: ");
|
||||
_DBH(event);
|
||||
_DBG("\n");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 2 Event Callback
|
||||
* Called automatically on USB Endpoint 2 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint2 (uint32_t event) {
|
||||
|
||||
switch (event) {
|
||||
case USB_EVT_OUT:
|
||||
CDC_BulkOut (); /* data received from Host */
|
||||
break;
|
||||
case USB_EVT_IN:
|
||||
CDC_BulkIn (); /* data expected from Host */
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 3 Event Callback
|
||||
* Called automatically on USB Endpoint 3 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint3 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 4 Event Callback
|
||||
* Called automatically on USB Endpoint 4 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint4 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 5 Event Callback
|
||||
* Called automatically on USB Endpoint 5 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint5 (uint32_t event) {
|
||||
switch (event) {
|
||||
case USB_EVT_OUT:
|
||||
MSC_BulkOut();
|
||||
break;
|
||||
case USB_EVT_IN:
|
||||
MSC_BulkIn();
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 6 Event Callback
|
||||
* Called automatically on USB Endpoint 6 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint6 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 7 Event Callback
|
||||
* Called automatically on USB Endpoint 7 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint7 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 8 Event Callback
|
||||
* Called automatically on USB Endpoint 8 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint8 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 9 Event Callback
|
||||
* Called automatically on USB Endpoint 9 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint9 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 10 Event Callback
|
||||
* Called automatically on USB Endpoint 10 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint10 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 11 Event Callback
|
||||
* Called automatically on USB Endpoint 11 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint11 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 12 Event Callback
|
||||
* Called automatically on USB Endpoint 12 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint12 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 13 Event Callback
|
||||
* Called automatically on USB Endpoint 13 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint13 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 14 Event Callback
|
||||
* Called automatically on USB Endpoint 14 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint14 (uint32_t event) {
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* USB Endpoint 15 Event Callback
|
||||
* Called automatically on USB Endpoint 15 Event
|
||||
* Parameter: event
|
||||
*/
|
||||
|
||||
void USB_EndPoint15 (uint32_t event) {
|
||||
}
|
|
@ -1,74 +0,0 @@
|
|||
/*----------------------------------------------------------------------------
|
||||
* U S B - K e r n e l
|
||||
*----------------------------------------------------------------------------
|
||||
* Name: usbuser.h
|
||||
* Purpose: USB Custom User Definitions
|
||||
* Version: V1.20
|
||||
*----------------------------------------------------------------------------
|
||||
* This software is supplied "AS IS" without any warranties, express,
|
||||
* implied or statutory, including but not limited to the implied
|
||||
* warranties of fitness for purpose, satisfactory quality and
|
||||
* noninfringement. Keil extends you a royalty-free right to reproduce
|
||||
* and distribute executable files created using this software for use
|
||||
* on NXP Semiconductors LPC family microcontroller devices only. Nothing
|
||||
* else gives you the right to use this software.
|
||||
*
|
||||
* Copyright (c) 2009 Keil - An ARM Company. All rights reserved.
|
||||
*---------------------------------------------------------------------------*/
|
||||
|
||||
#ifndef __USBUSER_H__
|
||||
#define __USBUSER_H__
|
||||
|
||||
|
||||
/* USB Device Events Callback Functions */
|
||||
extern void USB_Power_Event (uint32_t power);
|
||||
extern void USB_Reset_Event (void);
|
||||
extern void USB_Suspend_Event (void);
|
||||
extern void USB_Resume_Event (void);
|
||||
extern void USB_WakeUp_Event (void);
|
||||
extern void USB_SOF_Event (void);
|
||||
extern void USB_Error_Event (uint32_t error);
|
||||
|
||||
/* USB Endpoint Callback Events */
|
||||
#define USB_EVT_SETUP 1 /* Setup Packet */
|
||||
#define USB_EVT_OUT 2 /* OUT Packet */
|
||||
#define USB_EVT_IN 3 /* IN Packet */
|
||||
#define USB_EVT_OUT_NAK 4 /* OUT Packet - Not Acknowledged */
|
||||
#define USB_EVT_IN_NAK 5 /* IN Packet - Not Acknowledged */
|
||||
#define USB_EVT_OUT_STALL 6 /* OUT Packet - Stalled */
|
||||
#define USB_EVT_IN_STALL 7 /* IN Packet - Stalled */
|
||||
#define USB_EVT_OUT_DMA_EOT 8 /* DMA OUT EP - End of Transfer */
|
||||
#define USB_EVT_IN_DMA_EOT 9 /* DMA IN EP - End of Transfer */
|
||||
#define USB_EVT_OUT_DMA_NDR 10 /* DMA OUT EP - New Descriptor Request */
|
||||
#define USB_EVT_IN_DMA_NDR 11 /* DMA IN EP - New Descriptor Request */
|
||||
#define USB_EVT_OUT_DMA_ERR 12 /* DMA OUT EP - Error */
|
||||
#define USB_EVT_IN_DMA_ERR 13 /* DMA IN EP - Error */
|
||||
|
||||
/* USB Endpoint Events Callback Pointers */
|
||||
extern void (* const USB_P_EP[16])(uint32_t event);
|
||||
|
||||
/* USB Endpoint Events Callback Functions */
|
||||
extern void USB_EndPoint0 (uint32_t event);
|
||||
extern void USB_EndPoint1 (uint32_t event);
|
||||
extern void USB_EndPoint2 (uint32_t event);
|
||||
extern void USB_EndPoint3 (uint32_t event);
|
||||
extern void USB_EndPoint4 (uint32_t event);
|
||||
extern void USB_EndPoint5 (uint32_t event);
|
||||
extern void USB_EndPoint6 (uint32_t event);
|
||||
extern void USB_EndPoint7 (uint32_t event);
|
||||
extern void USB_EndPoint8 (uint32_t event);
|
||||
extern void USB_EndPoint9 (uint32_t event);
|
||||
extern void USB_EndPoint10 (uint32_t event);
|
||||
extern void USB_EndPoint11 (uint32_t event);
|
||||
extern void USB_EndPoint12 (uint32_t event);
|
||||
extern void USB_EndPoint13 (uint32_t event);
|
||||
extern void USB_EndPoint14 (uint32_t event);
|
||||
extern void USB_EndPoint15 (uint32_t event);
|
||||
|
||||
/* USB Core Events Callback Functions */
|
||||
extern void USB_Configure_Event (void);
|
||||
extern void USB_Interface_Event (void);
|
||||
extern void USB_Feature_Event (void);
|
||||
|
||||
|
||||
#endif /* __USBUSER_H__ */
|
|
@ -25,7 +25,7 @@ lib_deps =
|
|||
https://github.com/lincomatic/LiquidTWI2.git
|
||||
https://github.com/teemuatlut/TMC2130Stepper.git
|
||||
https://github.com/adafruit/Adafruit_NeoPixel.git
|
||||
default_src_filter = +<*> -<example_configurations> -<src/HAL/HAL_*>
|
||||
default_src_filter = +<*> -<example_configurations> -<src/HAL/HAL_*> -<frameworks>
|
||||
|
||||
[env:megaatmega2560]
|
||||
platform = atmelavr
|
||||
|
@ -106,6 +106,7 @@ framework = arduino
|
|||
board = teensy35
|
||||
build_flags = -I $BUILDSRC_DIR
|
||||
lib_deps = ${common.lib_deps}
|
||||
lib_ignore = Adafruit NeoPixel
|
||||
src_filter = ${common.default_src_filter} +<src/HAL/HAL_TEENSY35_36>
|
||||
|
||||
[env:Re-ARM]
|
||||
|
@ -114,5 +115,5 @@ board_f_cpu = 100000000L
|
|||
build_flags = !python Marlin/src/HAL/HAL_LPC1768/lpc1768_flag_script.py
|
||||
lib_ldf_mode = off
|
||||
lib_deps = U8glib-ARM
|
||||
src_filter = ${common.default_src_filter} +<src/HAL/HAL_LPC1768>
|
||||
src_filter = ${common.default_src_filter} +<src/HAL/HAL_LPC1768> +<frameworks/CMSIS/LPC1768>
|
||||
extra_scripts = Marlin/src/HAL/HAL_LPC1768/lpc1768_flag_script.py
|
||||
|
|
Reference in a new issue