mirror of
https://github.com/RT-Thread/rt-thread.git
synced 2026-02-06 17:12:01 +08:00
Merge branch 'master' of https://github.com/RT-Thread/rt-thread
This commit is contained in:
@@ -540,12 +540,17 @@ struct dirent *readdir(DIR *d)
|
||||
if (fd == RT_NULL)
|
||||
{
|
||||
rt_set_errno(-DFS_STATUS_EBADF);
|
||||
|
||||
return RT_NULL;
|
||||
}
|
||||
|
||||
if (!d->num ||
|
||||
(d->cur += ((struct dirent *)(d->buf + d->cur))->d_reclen) >= d->num)
|
||||
if (d->num)
|
||||
{
|
||||
struct dirent* dirent_ptr;
|
||||
dirent_ptr = (struct dirent*)&d->buf[d->cur];
|
||||
d->cur += dirent_ptr->d_reclen;
|
||||
}
|
||||
|
||||
if (!d->num || d->cur >= d->num)
|
||||
{
|
||||
/* get a new entry */
|
||||
result = dfs_file_getdents(fd,
|
||||
|
||||
@@ -1,8 +1,28 @@
|
||||
from building import *
|
||||
|
||||
cwd = GetCurrentDir()
|
||||
src = Glob('*.c')
|
||||
cwd = GetCurrentDir()
|
||||
src = ['spi_core.c', 'spi_dev.c']
|
||||
CPPPATH = [cwd + '/../include']
|
||||
|
||||
src_device = []
|
||||
|
||||
if GetDepend('RT_USING_SPI_WIFI'):
|
||||
src_device += ['spi_wifi_rw009.c']
|
||||
|
||||
if GetDepend('RT_USING_W25QXX'):
|
||||
src_device += ['spi_flash_w25qxx.c']
|
||||
|
||||
if GetDepend('RT_USING_ENC28J60'):
|
||||
src_device += ['enc28j60.c']
|
||||
|
||||
if GetDepend('RT_USING_AT45DBXX'):
|
||||
src_device += ['spi_flash_at45dbxx.c']
|
||||
|
||||
if GetDepend('RT_USING_SST25VFXX'):
|
||||
src_device += ['spi_flash_sst25vfxx.c']
|
||||
|
||||
src += src_device
|
||||
|
||||
group = DefineGroup('DeviceDrivers', src, depend = ['RT_USING_SPI'], CPPPATH = CPPPATH)
|
||||
|
||||
Return('group')
|
||||
|
||||
15
components/drivers/spi/device_driver_list.txt
Normal file
15
components/drivers/spi/device_driver_list.txt
Normal file
@@ -0,0 +1,15 @@
|
||||
spi_wifi_rw009.c/spi_wifi_rw009.h
|
||||
RW009
|
||||
http://www.rt-thread.com/
|
||||
|
||||
enc28j60.c/enc28j60.h
|
||||
http://www.microchip.com/
|
||||
|
||||
spi_flash_at45dbxx.c/spi_flash_at45dbxx.h
|
||||
http://www.atmel.com/
|
||||
|
||||
spi_flash_sst25vfxx.c/spi_flash_sst25vfxx.h
|
||||
http://www.microchip.com/
|
||||
|
||||
spi_flash_w25qxx.c/spi_flash_w25qxx.h
|
||||
http://www.winbond.com/
|
||||
876
components/drivers/spi/enc28j60.c
Normal file
876
components/drivers/spi/enc28j60.c
Normal file
File diff suppressed because it is too large
Load Diff
329
components/drivers/spi/enc28j60.h
Normal file
329
components/drivers/spi/enc28j60.h
Normal file
@@ -0,0 +1,329 @@
|
||||
#ifndef EN28J60_H_INCLUDED
|
||||
#define EN28J60_H_INCLUDED
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/spi.h>
|
||||
#include <netif/ethernetif.h>
|
||||
|
||||
// ENC28J60 Control Registers
|
||||
// Control register definitions are a combination of address,
|
||||
// bank number, and Ethernet/MAC/PHY indicator bits.
|
||||
// - Register address (bits 0-4)
|
||||
// - Bank number (bits 5-6)
|
||||
// - MAC/PHY indicator (bit 7)
|
||||
#define ADDR_MASK 0x1F
|
||||
#define BANK_MASK 0x60
|
||||
#define SPRD_MASK 0x80
|
||||
// All-bank registers
|
||||
#define EIE 0x1B
|
||||
#define EIR 0x1C
|
||||
#define ESTAT 0x1D
|
||||
#define ECON2 0x1E
|
||||
#define ECON1 0x1F
|
||||
// Bank 0 registers
|
||||
#define ERDPTL (0x00|0x00)
|
||||
#define ERDPTH (0x01|0x00)
|
||||
#define EWRPTL (0x02|0x00)
|
||||
#define EWRPTH (0x03|0x00)
|
||||
#define ETXSTL (0x04|0x00)
|
||||
#define ETXSTH (0x05|0x00)
|
||||
#define ETXNDL (0x06|0x00)
|
||||
#define ETXNDH (0x07|0x00)
|
||||
#define ERXSTL (0x08|0x00)
|
||||
#define ERXSTH (0x09|0x00)
|
||||
#define ERXNDL (0x0A|0x00)
|
||||
#define ERXNDH (0x0B|0x00)
|
||||
#define ERXRDPTL (0x0C|0x00)
|
||||
#define ERXRDPTH (0x0D|0x00)
|
||||
#define ERXWRPTL (0x0E|0x00)
|
||||
#define ERXWRPTH (0x0F|0x00)
|
||||
#define EDMASTL (0x10|0x00)
|
||||
#define EDMASTH (0x11|0x00)
|
||||
#define EDMANDL (0x12|0x00)
|
||||
#define EDMANDH (0x13|0x00)
|
||||
#define EDMADSTL (0x14|0x00)
|
||||
#define EDMADSTH (0x15|0x00)
|
||||
#define EDMACSL (0x16|0x00)
|
||||
#define EDMACSH (0x17|0x00)
|
||||
// Bank 1 registers
|
||||
#define EHT0 (0x00|0x20)
|
||||
#define EHT1 (0x01|0x20)
|
||||
#define EHT2 (0x02|0x20)
|
||||
#define EHT3 (0x03|0x20)
|
||||
#define EHT4 (0x04|0x20)
|
||||
#define EHT5 (0x05|0x20)
|
||||
#define EHT6 (0x06|0x20)
|
||||
#define EHT7 (0x07|0x20)
|
||||
#define EPMM0 (0x08|0x20)
|
||||
#define EPMM1 (0x09|0x20)
|
||||
#define EPMM2 (0x0A|0x20)
|
||||
#define EPMM3 (0x0B|0x20)
|
||||
#define EPMM4 (0x0C|0x20)
|
||||
#define EPMM5 (0x0D|0x20)
|
||||
#define EPMM6 (0x0E|0x20)
|
||||
#define EPMM7 (0x0F|0x20)
|
||||
#define EPMCSL (0x10|0x20)
|
||||
#define EPMCSH (0x11|0x20)
|
||||
#define EPMOL (0x14|0x20)
|
||||
#define EPMOH (0x15|0x20)
|
||||
#define EWOLIE (0x16|0x20)
|
||||
#define EWOLIR (0x17|0x20)
|
||||
#define ERXFCON (0x18|0x20)
|
||||
#define EPKTCNT (0x19|0x20)
|
||||
// Bank 2 registers
|
||||
#define MACON1 (0x00|0x40|0x80)
|
||||
#define MACON2 (0x01|0x40|0x80)
|
||||
#define MACON3 (0x02|0x40|0x80)
|
||||
#define MACON4 (0x03|0x40|0x80)
|
||||
#define MABBIPG (0x04|0x40|0x80)
|
||||
#define MAIPGL (0x06|0x40|0x80)
|
||||
#define MAIPGH (0x07|0x40|0x80)
|
||||
#define MACLCON1 (0x08|0x40|0x80)
|
||||
#define MACLCON2 (0x09|0x40|0x80)
|
||||
#define MAMXFLL (0x0A|0x40|0x80)
|
||||
#define MAMXFLH (0x0B|0x40|0x80)
|
||||
#define MAPHSUP (0x0D|0x40|0x80)
|
||||
#define MICON (0x11|0x40|0x80)
|
||||
#define MICMD (0x12|0x40|0x80)
|
||||
#define MIREGADR (0x14|0x40|0x80)
|
||||
#define MIWRL (0x16|0x40|0x80)
|
||||
#define MIWRH (0x17|0x40|0x80)
|
||||
#define MIRDL (0x18|0x40|0x80)
|
||||
#define MIRDH (0x19|0x40|0x80)
|
||||
// Bank 3 registers
|
||||
#define MAADR1 (0x00|0x60|0x80)
|
||||
#define MAADR0 (0x01|0x60|0x80)
|
||||
#define MAADR3 (0x02|0x60|0x80)
|
||||
#define MAADR2 (0x03|0x60|0x80)
|
||||
#define MAADR5 (0x04|0x60|0x80)
|
||||
#define MAADR4 (0x05|0x60|0x80)
|
||||
#define EBSTSD (0x06|0x60)
|
||||
#define EBSTCON (0x07|0x60)
|
||||
#define EBSTCSL (0x08|0x60)
|
||||
#define EBSTCSH (0x09|0x60)
|
||||
#define MISTAT (0x0A|0x60|0x80)
|
||||
#define EREVID (0x12|0x60)
|
||||
#define ECOCON (0x15|0x60)
|
||||
#define EFLOCON (0x17|0x60)
|
||||
#define EPAUSL (0x18|0x60)
|
||||
#define EPAUSH (0x19|0x60)
|
||||
// PHY registers
|
||||
#define PHCON1 0x00
|
||||
#define PHSTAT1 0x01
|
||||
#define PHHID1 0x02
|
||||
#define PHHID2 0x03
|
||||
#define PHCON2 0x10
|
||||
#define PHSTAT2 0x11
|
||||
#define PHIE 0x12
|
||||
#define PHIR 0x13
|
||||
#define PHLCON 0x14
|
||||
|
||||
// ENC28J60 ERXFCON Register Bit Definitions
|
||||
#define ERXFCON_UCEN 0x80
|
||||
#define ERXFCON_ANDOR 0x40
|
||||
#define ERXFCON_CRCEN 0x20
|
||||
#define ERXFCON_PMEN 0x10
|
||||
#define ERXFCON_MPEN 0x08
|
||||
#define ERXFCON_HTEN 0x04
|
||||
#define ERXFCON_MCEN 0x02
|
||||
#define ERXFCON_BCEN 0x01
|
||||
// ENC28J60 EIE Register Bit Definitions
|
||||
#define EIE_INTIE 0x80
|
||||
#define EIE_PKTIE 0x40
|
||||
#define EIE_DMAIE 0x20
|
||||
#define EIE_LINKIE 0x10
|
||||
#define EIE_TXIE 0x08
|
||||
#define EIE_WOLIE 0x04
|
||||
#define EIE_TXERIE 0x02
|
||||
#define EIE_RXERIE 0x01
|
||||
// ENC28J60 EIR Register Bit Definitions
|
||||
#define EIR_PKTIF 0x40
|
||||
#define EIR_DMAIF 0x20
|
||||
#define EIR_LINKIF 0x10
|
||||
#define EIR_TXIF 0x08
|
||||
#define EIR_WOLIF 0x04
|
||||
#define EIR_TXERIF 0x02
|
||||
#define EIR_RXERIF 0x01
|
||||
// ENC28J60 ESTAT Register Bit Definitions
|
||||
#define ESTAT_INT 0x80
|
||||
#define ESTAT_LATECOL 0x10
|
||||
#define ESTAT_RXBUSY 0x04
|
||||
#define ESTAT_TXABRT 0x02
|
||||
#define ESTAT_CLKRDY 0x01
|
||||
// ENC28J60 ECON2 Register Bit Definitions
|
||||
#define ECON2_AUTOINC 0x80
|
||||
#define ECON2_PKTDEC 0x40
|
||||
#define ECON2_PWRSV 0x20
|
||||
#define ECON2_VRPS 0x08
|
||||
// ENC28J60 ECON1 Register Bit Definitions
|
||||
#define ECON1_TXRST 0x80
|
||||
#define ECON1_RXRST 0x40
|
||||
#define ECON1_DMAST 0x20
|
||||
#define ECON1_CSUMEN 0x10
|
||||
#define ECON1_TXRTS 0x08
|
||||
#define ECON1_RXEN 0x04
|
||||
#define ECON1_BSEL1 0x02
|
||||
#define ECON1_BSEL0 0x01
|
||||
// ENC28J60 MACON1 Register Bit Definitions
|
||||
#define MACON1_LOOPBK 0x10
|
||||
#define MACON1_TXPAUS 0x08
|
||||
#define MACON1_RXPAUS 0x04
|
||||
#define MACON1_PASSALL 0x02
|
||||
#define MACON1_MARXEN 0x01
|
||||
// ENC28J60 MACON2 Register Bit Definitions
|
||||
#define MACON2_MARST 0x80
|
||||
#define MACON2_RNDRST 0x40
|
||||
#define MACON2_MARXRST 0x08
|
||||
#define MACON2_RFUNRST 0x04
|
||||
#define MACON2_MATXRST 0x02
|
||||
#define MACON2_TFUNRST 0x01
|
||||
// ENC28J60 MACON3 Register Bit Definitions
|
||||
#define MACON3_PADCFG2 0x80
|
||||
#define MACON3_PADCFG1 0x40
|
||||
#define MACON3_PADCFG0 0x20
|
||||
#define MACON3_TXCRCEN 0x10
|
||||
#define MACON3_PHDRLEN 0x08
|
||||
#define MACON3_HFRMLEN 0x04
|
||||
#define MACON3_FRMLNEN 0x02
|
||||
#define MACON3_FULDPX 0x01
|
||||
// ENC28J60 MACON4 Register Bit Definitions
|
||||
#define MACON4_DEFER (1<<6)
|
||||
#define MACON4_BPEN (1<<5)
|
||||
#define MACON4_NOBKOFF (1<<4)
|
||||
// ENC28J60 MICMD Register Bit Definitions
|
||||
#define MICMD_MIISCAN 0x02
|
||||
#define MICMD_MIIRD 0x01
|
||||
// ENC28J60 MISTAT Register Bit Definitions
|
||||
#define MISTAT_NVALID 0x04
|
||||
#define MISTAT_SCAN 0x02
|
||||
#define MISTAT_BUSY 0x01
|
||||
// ENC28J60 PHY PHCON1 Register Bit Definitions
|
||||
#define PHCON1_PRST 0x8000
|
||||
#define PHCON1_PLOOPBK 0x4000
|
||||
#define PHCON1_PPWRSV 0x0800
|
||||
#define PHCON1_PDPXMD 0x0100
|
||||
// ENC28J60 PHY PHSTAT1 Register Bit Definitions
|
||||
#define PHSTAT1_PFDPX 0x1000
|
||||
#define PHSTAT1_PHDPX 0x0800
|
||||
#define PHSTAT1_LLSTAT 0x0004
|
||||
#define PHSTAT1_JBSTAT 0x0002
|
||||
/* ENC28J60 PHY PHSTAT2 Register Bit Definitions */
|
||||
#define PHSTAT2_TXSTAT (1 << 13)
|
||||
#define PHSTAT2_RXSTAT (1 << 12)
|
||||
#define PHSTAT2_COLSTAT (1 << 11)
|
||||
#define PHSTAT2_LSTAT (1 << 10)
|
||||
#define PHSTAT2_DPXSTAT (1 << 9)
|
||||
#define PHSTAT2_PLRITY (1 << 5)
|
||||
// ENC28J60 PHY PHCON2 Register Bit Definitions
|
||||
#define PHCON2_FRCLINK 0x4000
|
||||
#define PHCON2_TXDIS 0x2000
|
||||
#define PHCON2_JABBER 0x0400
|
||||
#define PHCON2_HDLDIS 0x0100
|
||||
|
||||
// ENC28J60 Packet Control Byte Bit Definitions
|
||||
#define PKTCTRL_PHUGEEN 0x08
|
||||
#define PKTCTRL_PPADEN 0x04
|
||||
#define PKTCTRL_PCRCEN 0x02
|
||||
#define PKTCTRL_POVERRIDE 0x01
|
||||
|
||||
/* ENC28J60 Transmit Status Vector */
|
||||
#define TSV_TXBYTECNT 0
|
||||
#define TSV_TXCOLLISIONCNT 16
|
||||
#define TSV_TXCRCERROR 20
|
||||
#define TSV_TXLENCHKERROR 21
|
||||
#define TSV_TXLENOUTOFRANGE 22
|
||||
#define TSV_TXDONE 23
|
||||
#define TSV_TXMULTICAST 24
|
||||
#define TSV_TXBROADCAST 25
|
||||
#define TSV_TXPACKETDEFER 26
|
||||
#define TSV_TXEXDEFER 27
|
||||
#define TSV_TXEXCOLLISION 28
|
||||
#define TSV_TXLATECOLLISION 29
|
||||
#define TSV_TXGIANT 30
|
||||
#define TSV_TXUNDERRUN 31
|
||||
#define TSV_TOTBYTETXONWIRE 32
|
||||
#define TSV_TXCONTROLFRAME 48
|
||||
#define TSV_TXPAUSEFRAME 49
|
||||
#define TSV_BACKPRESSUREAPP 50
|
||||
#define TSV_TXVLANTAGFRAME 51
|
||||
|
||||
#define TSV_SIZE 7
|
||||
#define TSV_BYTEOF(x) ((x) / 8)
|
||||
#define TSV_BITMASK(x) (1 << ((x) % 8))
|
||||
#define TSV_GETBIT(x, y) (((x)[TSV_BYTEOF(y)] & TSV_BITMASK(y)) ? 1 : 0)
|
||||
|
||||
/* ENC28J60 Receive Status Vector */
|
||||
#define RSV_RXLONGEVDROPEV 16
|
||||
#define RSV_CARRIEREV 18
|
||||
#define RSV_CRCERROR 20
|
||||
#define RSV_LENCHECKERR 21
|
||||
#define RSV_LENOUTOFRANGE 22
|
||||
#define RSV_RXOK 23
|
||||
#define RSV_RXMULTICAST 24
|
||||
#define RSV_RXBROADCAST 25
|
||||
#define RSV_DRIBBLENIBBLE 26
|
||||
#define RSV_RXCONTROLFRAME 27
|
||||
#define RSV_RXPAUSEFRAME 28
|
||||
#define RSV_RXUNKNOWNOPCODE 29
|
||||
#define RSV_RXTYPEVLAN 30
|
||||
|
||||
#define RSV_SIZE 6
|
||||
#define RSV_BITMASK(x) (1 << ((x) - 16))
|
||||
#define RSV_GETBIT(x, y) (((x) & RSV_BITMASK(y)) ? 1 : 0)
|
||||
|
||||
// SPI operation codes
|
||||
#define ENC28J60_READ_CTRL_REG 0x00
|
||||
#define ENC28J60_READ_BUF_MEM 0x3A
|
||||
#define ENC28J60_WRITE_CTRL_REG 0x40
|
||||
#define ENC28J60_WRITE_BUF_MEM 0x7A
|
||||
#define ENC28J60_BIT_FIELD_SET 0x80
|
||||
#define ENC28J60_BIT_FIELD_CLR 0xA0
|
||||
#define ENC28J60_SOFT_RESET 0xFF
|
||||
|
||||
// The RXSTART_INIT should be zero. See Rev. B4 Silicon Errata
|
||||
// buffer boundaries applied to internal 8K ram
|
||||
// the entire available packet buffer space is allocated
|
||||
//
|
||||
|
||||
#define MAX_TX_PACKAGE_SIZE (1536)
|
||||
|
||||
// start with recbuf at 0/
|
||||
#define RXSTART_INIT 0x0
|
||||
// receive buffer end
|
||||
#define RXSTOP_INIT (0x1FFF - MAX_TX_PACKAGE_SIZE*2) - 1
|
||||
// start TX buffer at 0x1FFF-0x0600, pace for one full ethernet frame (~1500 bytes)
|
||||
|
||||
#define TXSTART_INIT (0x1FFF - MAX_TX_PACKAGE_SIZE*2)
|
||||
// stp TX buffer at end of mem
|
||||
#define TXSTOP_INIT 0x1FFF
|
||||
|
||||
// max frame length which the conroller will accept:
|
||||
#define MAX_FRAMELEN 1518
|
||||
|
||||
#define MAX_ADDR_LEN 6
|
||||
|
||||
struct net_device
|
||||
{
|
||||
/* inherit from ethernet device */
|
||||
struct eth_device parent;
|
||||
|
||||
/* interface address info. */
|
||||
rt_uint8_t dev_addr[MAX_ADDR_LEN]; /* hw address */
|
||||
|
||||
rt_uint8_t emac_rev;
|
||||
rt_uint8_t phy_rev;
|
||||
rt_uint8_t phy_pn;
|
||||
rt_uint32_t phy_id;
|
||||
|
||||
/* spi device */
|
||||
struct rt_spi_device * spi_device;
|
||||
struct rt_mutex lock;
|
||||
};
|
||||
|
||||
/* export function */
|
||||
extern rt_err_t enc28j60_attach(const char * spi_device_name);
|
||||
extern void enc28j60_isr(void);
|
||||
|
||||
#endif // EN28J60_H_INCLUDED
|
||||
437
components/drivers/spi/spi_flash_at45dbxx.c
Normal file
437
components/drivers/spi/spi_flash_at45dbxx.c
Normal file
@@ -0,0 +1,437 @@
|
||||
/*
|
||||
* File : rtdef.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-16 aozima the first version
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include "spi_flash_at45dbxx.h"
|
||||
|
||||
#define FLASH_DEBUG
|
||||
#define DMA_BUFFER_SIZE 512
|
||||
|
||||
#ifdef FLASH_DEBUG
|
||||
#define FLASH_TRACE rt_kprintf
|
||||
#else
|
||||
#define FLASH_TRACE(...)
|
||||
#endif /**< #ifdef FLASH_DEBUG */
|
||||
|
||||
/* JEDEC Manufacturer¡¯s ID */
|
||||
#define MF_ID (0x1F) /* atmel */
|
||||
#define DENSITY_CODE_011D (0x02) /* AT45DB011D Density Code : 00010 = 1-Mbit */
|
||||
#define DENSITY_CODE_021D (0x03) /* AT45DB021D Density Code : 00011 = 2-Mbit */
|
||||
#define DENSITY_CODE_041D (0x04) /* AT45DB041D Density Code : 00100 = 4-Mbit */
|
||||
#define DENSITY_CODE_081D (0x05) /* AT45DB081D Density Code : 00101 = 8-Mbit */
|
||||
#define DENSITY_CODE_161D (0x06) /* AT45DB161D Density Code : 00110 = 16-Mbit */
|
||||
#define DENSITY_CODE_321D (0x07) /* AT45DB321D Density Code : 00111 = 32-Mbit */
|
||||
#define DENSITY_CODE_642D (0x08) /* AT45DB642D Density Code : 01000 = 64-Mbit */
|
||||
|
||||
struct JEDEC_ID
|
||||
{
|
||||
uint8_t manufacturer_id; /* Manufacturer ID */
|
||||
uint8_t density_code:5; /* Density Code */
|
||||
uint8_t family_code:3; /* Family Code */
|
||||
uint8_t version_code:5; /* Product Version Code */
|
||||
uint8_t mlc_code:3; /* MLC Code */
|
||||
uint8_t byte_count; /* Byte Count */
|
||||
};
|
||||
|
||||
#define AT45DB_BUFFER_1_WRITE 0x84
|
||||
#define AT45DB_BUFFER_2_WRITE 0x87
|
||||
#define AT45DB_BUFFER_1_READ 0xD4
|
||||
#define AT45DB_BUFFER_2_READ 0xD6
|
||||
#define AT45DB_B1_TO_MM_PAGE_PROG_WITH_ERASE 0x83
|
||||
#define AT45DB_B2_TO_MM_PAGE_PROG_WITH_ERASE 0x86
|
||||
#define AT45DB_MM_PAGE_TO_B1_XFER 0x53
|
||||
#define AT45DB_MM_PAGE_TO_B2_XFER 0x55
|
||||
#define AT45DB_PAGE_ERASE 0x81
|
||||
#define AT45DB_SECTOR_ERASE 0x7C
|
||||
#define AT45DB_READ_STATE_REGISTER 0xD7
|
||||
#define AT45DB_MM_PAGE_READ 0xD2
|
||||
#define AT45DB_MM_PAGE_PROG_THRU_BUFFER1 0x82
|
||||
#define AT45DB_CMD_JEDEC_ID 0x9F
|
||||
|
||||
static struct spi_flash_at45dbxx spi_flash_at45dbxx;
|
||||
|
||||
/*****************************************************************************/
|
||||
/*Status Register Format: */
|
||||
/* ------------------------------------------------------------------------- */
|
||||
/* | bit7 | bit6 | bit5 | bit4 | bit3 | bit2 | bit1 | bit0 | */
|
||||
/* |--------|--------|--------|--------|--------|--------|--------|--------| */
|
||||
/* |RDY/BUSY| COMP | device density | X | X | */
|
||||
/* ------------------------------------------------------------------------- */
|
||||
/* 0:busy | | AT45DB041:0111 | protect|page size */
|
||||
/* 1:ready | | AT45DB161:1011 | */
|
||||
/* --------------------------------------------------------------------------*/
|
||||
/*****************************************************************************/
|
||||
static uint8_t AT45DB_StatusRegisterRead(void)
|
||||
{
|
||||
return rt_spi_sendrecv8(spi_flash_at45dbxx.rt_spi_device, AT45DB_READ_STATE_REGISTER);
|
||||
}
|
||||
|
||||
static void wait_busy(void)
|
||||
{
|
||||
uint16_t i = 0;
|
||||
while (i++ < 10000)
|
||||
{
|
||||
if (AT45DB_StatusRegisterRead() & 0x80)
|
||||
{
|
||||
return;
|
||||
}
|
||||
}
|
||||
FLASH_TRACE("\r\nSPI_FLASH timeout!!!\r\n");
|
||||
}
|
||||
|
||||
/* RT-Thread Device Driver Interface */
|
||||
static rt_err_t AT45DB_flash_init(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t AT45DB_flash_open(rt_device_t dev, rt_uint16_t oflag)
|
||||
{
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t AT45DB_flash_close(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t AT45DB_flash_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
|
||||
if (cmd == RT_DEVICE_CTRL_BLK_GETGEOME)
|
||||
{
|
||||
struct rt_device_blk_geometry *geometry;
|
||||
|
||||
geometry = (struct rt_device_blk_geometry *)args;
|
||||
if (geometry == RT_NULL) return -RT_ERROR;
|
||||
|
||||
geometry->bytes_per_sector = 512;
|
||||
geometry->sector_count = 4096;
|
||||
geometry->block_size = 4096; /* block erase: 4k */
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_size_t AT45DB_flash_read_page_256(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
||||
{
|
||||
uint32_t index, nr;
|
||||
uint8_t * read_buffer = buffer;
|
||||
|
||||
nr = size;
|
||||
|
||||
for (index = 0; index < nr; index++)
|
||||
{
|
||||
uint32_t page = pos;
|
||||
uint8_t send_buffer[8];
|
||||
uint32_t i;
|
||||
|
||||
for(i=0; i<sizeof(send_buffer); i++)
|
||||
{
|
||||
send_buffer[i] = 0;
|
||||
}
|
||||
|
||||
send_buffer[0] = AT45DB_MM_PAGE_READ;
|
||||
send_buffer[1] = (uint8_t)(page >> 7);
|
||||
send_buffer[2] = (uint8_t)(page << 1);
|
||||
|
||||
rt_spi_send_then_recv(spi_flash_at45dbxx.rt_spi_device, send_buffer, 8, read_buffer, 256);
|
||||
read_buffer += 256;
|
||||
page++;
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t AT45DB_flash_read_page_512(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
||||
{
|
||||
uint32_t index, nr;
|
||||
uint8_t * read_buffer = buffer;
|
||||
|
||||
nr = size;
|
||||
|
||||
for (index = 0; index < nr; index++)
|
||||
{
|
||||
uint32_t page = pos;
|
||||
uint8_t send_buffer[8];
|
||||
uint32_t i;
|
||||
|
||||
for(i=0; i<sizeof(send_buffer); i++)
|
||||
{
|
||||
send_buffer[i] = 0;
|
||||
}
|
||||
|
||||
send_buffer[0] = AT45DB_MM_PAGE_READ;
|
||||
send_buffer[1] = (uint8_t)(page >> 6);
|
||||
send_buffer[2] = (uint8_t)(page << 2);
|
||||
|
||||
rt_spi_send_then_recv(spi_flash_at45dbxx.rt_spi_device, send_buffer, 8, read_buffer, 512);
|
||||
read_buffer += 512;
|
||||
page++;
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t AT45DB_flash_read_page_1024(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
||||
{
|
||||
uint32_t index, nr;
|
||||
uint8_t * read_buffer = buffer;
|
||||
|
||||
nr = size;
|
||||
|
||||
for (index = 0; index < nr; index++)
|
||||
{
|
||||
uint32_t page = pos;
|
||||
uint8_t send_buffer[8];
|
||||
uint32_t i;
|
||||
|
||||
for(i=0; i<sizeof(send_buffer); i++)
|
||||
{
|
||||
send_buffer[i] = 0;
|
||||
}
|
||||
|
||||
send_buffer[0] = AT45DB_MM_PAGE_READ;
|
||||
send_buffer[1] = (uint8_t)(page >> 5);
|
||||
send_buffer[2] = (uint8_t)(page << 3);
|
||||
|
||||
rt_spi_send_then_recv(spi_flash_at45dbxx.rt_spi_device, send_buffer, 8, read_buffer, 1024);
|
||||
read_buffer += 1024;
|
||||
page++;
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t AT45DB_flash_write_page_256(rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
||||
{
|
||||
rt_uint32_t index, nr;
|
||||
const uint8_t * write_buffer = buffer;
|
||||
|
||||
nr = size;
|
||||
|
||||
for (index = 0; index < nr; index++)
|
||||
{
|
||||
uint32_t page = pos;
|
||||
uint8_t send_buffer[4];
|
||||
|
||||
send_buffer[0] = AT45DB_MM_PAGE_PROG_THRU_BUFFER1;
|
||||
send_buffer[1] = (uint8_t) (page >> 7);
|
||||
send_buffer[2] = (uint8_t) (page << 1);
|
||||
send_buffer[3] = 0;
|
||||
|
||||
rt_spi_send_then_send(spi_flash_at45dbxx.rt_spi_device, send_buffer, 4, write_buffer, 256);
|
||||
|
||||
write_buffer += 256;
|
||||
page++;
|
||||
|
||||
wait_busy();
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t AT45DB_flash_write_page_512(rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
||||
{
|
||||
rt_uint32_t index, nr;
|
||||
const uint8_t * write_buffer = buffer;
|
||||
|
||||
nr = size;
|
||||
|
||||
for (index = 0; index < nr; index++)
|
||||
{
|
||||
uint32_t page = pos;
|
||||
uint8_t send_buffer[4];
|
||||
|
||||
send_buffer[0] = AT45DB_MM_PAGE_PROG_THRU_BUFFER1;
|
||||
send_buffer[1] = (uint8_t) (page >> 6);
|
||||
send_buffer[2] = (uint8_t) (page << 2);
|
||||
send_buffer[3] = 0;
|
||||
|
||||
rt_spi_send_then_send(spi_flash_at45dbxx.rt_spi_device, send_buffer, 4, write_buffer, 512);
|
||||
|
||||
write_buffer += 512;
|
||||
page++;
|
||||
|
||||
wait_busy();
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t AT45DB_flash_write_page_1024(rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
||||
{
|
||||
rt_uint32_t index, nr;
|
||||
const uint8_t * write_buffer = buffer;
|
||||
|
||||
nr = size;
|
||||
|
||||
for (index = 0; index < nr; index++)
|
||||
{
|
||||
uint32_t page = pos;
|
||||
uint8_t send_buffer[4];
|
||||
|
||||
send_buffer[0] = AT45DB_MM_PAGE_PROG_THRU_BUFFER1;
|
||||
send_buffer[1] = (uint8_t) (page >> 5);
|
||||
send_buffer[2] = (uint8_t) (page << 3);
|
||||
send_buffer[3] = 0;
|
||||
|
||||
rt_spi_send_then_send(spi_flash_at45dbxx.rt_spi_device, send_buffer, 4, write_buffer, 1024);
|
||||
|
||||
write_buffer += 1024;
|
||||
page++;
|
||||
|
||||
wait_busy();
|
||||
}
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
rt_err_t at45dbxx_init(const char * flash_device_name, const char * spi_device_name)
|
||||
{
|
||||
struct rt_spi_device * rt_spi_device;
|
||||
struct JEDEC_ID * JEDEC_ID;
|
||||
|
||||
rt_spi_device = (struct rt_spi_device *)rt_device_find(spi_device_name);
|
||||
if(rt_spi_device == RT_NULL)
|
||||
{
|
||||
FLASH_TRACE("spi device %s not found!\r\n", spi_device_name);
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
spi_flash_at45dbxx.rt_spi_device = rt_spi_device;
|
||||
|
||||
/* config spi */
|
||||
{
|
||||
struct rt_spi_configuration cfg;
|
||||
cfg.data_width = 8;
|
||||
cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible Modes 0 and 3 */
|
||||
cfg.max_hz = 66000000; /* Atmel RapidS Serial Interface: 66MHz Maximum Clock Frequency */
|
||||
rt_spi_configure(spi_flash_at45dbxx.rt_spi_device, &cfg);
|
||||
}
|
||||
|
||||
/* read JEDEC ID */
|
||||
{
|
||||
uint8_t cmd;
|
||||
uint8_t id_recv[6];
|
||||
JEDEC_ID = (struct JEDEC_ID *)id_recv;
|
||||
|
||||
cmd = AT45DB_CMD_JEDEC_ID;
|
||||
rt_spi_send_then_recv(spi_flash_at45dbxx.rt_spi_device, &cmd, 1, id_recv, 6);
|
||||
|
||||
/**< 1FH = Atmel */
|
||||
/**< 001 = Atmel DataFlash */
|
||||
if(JEDEC_ID->manufacturer_id != 0x1F || JEDEC_ID->family_code != 0x01)
|
||||
{
|
||||
FLASH_TRACE("Manufacturer¡¯s ID or Memory Type error!\r\n");
|
||||
FLASH_TRACE("JEDEC Read-ID Data : %02X %02X %02X\r\n", id_recv[0], id_recv[1], id_recv[2]);
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
|
||||
if(JEDEC_ID->density_code == DENSITY_CODE_011D)
|
||||
{
|
||||
/**< AT45DB011D Density Code : 00010 = 1-Mbit */
|
||||
FLASH_TRACE("AT45DB011D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 256; /* Page Erase (256 Bytes) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 512; /* 1-Mbit / 8 / 256 = 512 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*2; /* Block Erase (2-Kbytes) */
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_021D)
|
||||
{
|
||||
/**< AT45DB021D Density Code : 00011 = 2-Mbit */
|
||||
FLASH_TRACE("AT45DB021D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 256; /* Page Erase (256 Bytes) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 512*2; /* 2-Mbit / 8 / 256 = 1024 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*2; /* Block Erase (2-Kbytes) */
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_041D)
|
||||
{
|
||||
/**< AT45DB041D Density Code : 00100 = 4-Mbit */
|
||||
FLASH_TRACE("AT45DB041D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 256; /* Page Erase (256 Bytes) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 512*4; /* 4-Mbit / 8 / 256 = 2048 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*2; /* Block Erase (2-Kbytes) */
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_081D)
|
||||
{
|
||||
/**< AT45DB081D Density Code : 00101 = 8-Mbit */
|
||||
FLASH_TRACE("AT45DB081D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 256; /* Page Erase (256 Bytes) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 512*8; /* 8-Mbit / 8 / 256 = 4096 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*2; /* Block Erase (2-Kbytes) */
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_161D)
|
||||
{
|
||||
/**< AT45DB161D Density Code : 00110 = 16-Mbit */
|
||||
FLASH_TRACE("AT45DB161D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 512; /* Page Erase (512 Bytes) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 256*16; /* 16-Mbit / 8 / 512 = 4096 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*4; /* Block Erase (4-Kbytes) */
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_321D)
|
||||
{
|
||||
/**< AT45DB321D Density Code : 00111 = 32-Mbit */
|
||||
FLASH_TRACE("AT45DB321D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 512; /* Page Erase (512 Bytes) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 256*32; /* 32-Mbit / 8 / 512 = 8192 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*4; /* Block Erase (4-Kbytes) */
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_642D)
|
||||
{
|
||||
/**< AT45DB642D Density Code : 01000 = 64-Mbit */
|
||||
FLASH_TRACE("AT45DB642D detection\r\n");
|
||||
spi_flash_at45dbxx.geometry.bytes_per_sector = 1024; /* Page Erase (1 Kbyte) */
|
||||
spi_flash_at45dbxx.geometry.sector_count = 128*64; /* 64-Mbit / 8 / 1024 = 8192 */
|
||||
spi_flash_at45dbxx.geometry.block_size = 1024*8; /* Block Erase (8 Kbytes) */
|
||||
}
|
||||
else
|
||||
{
|
||||
FLASH_TRACE("Memory Capacity error!\r\n");
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
}
|
||||
|
||||
/* register device */
|
||||
spi_flash_at45dbxx.flash_device.type = RT_Device_Class_Block;
|
||||
spi_flash_at45dbxx.flash_device.init = AT45DB_flash_init;
|
||||
spi_flash_at45dbxx.flash_device.open = AT45DB_flash_open;
|
||||
spi_flash_at45dbxx.flash_device.close = AT45DB_flash_close;
|
||||
spi_flash_at45dbxx.flash_device.control = AT45DB_flash_control;
|
||||
|
||||
if(JEDEC_ID->density_code == DENSITY_CODE_642D)
|
||||
{
|
||||
spi_flash_at45dbxx.flash_device.read = AT45DB_flash_read_page_1024;
|
||||
spi_flash_at45dbxx.flash_device.write = AT45DB_flash_write_page_1024;
|
||||
}
|
||||
else if(JEDEC_ID->density_code == DENSITY_CODE_161D
|
||||
|| JEDEC_ID->density_code == DENSITY_CODE_321D )
|
||||
{
|
||||
spi_flash_at45dbxx.flash_device.read = AT45DB_flash_read_page_512;
|
||||
spi_flash_at45dbxx.flash_device.write = AT45DB_flash_write_page_512;
|
||||
}
|
||||
else
|
||||
{
|
||||
spi_flash_at45dbxx.flash_device.read = AT45DB_flash_read_page_256;
|
||||
spi_flash_at45dbxx.flash_device.write = AT45DB_flash_write_page_256;
|
||||
}
|
||||
|
||||
/* no private */
|
||||
spi_flash_at45dbxx.flash_device.user_data = RT_NULL;
|
||||
|
||||
rt_device_register(&spi_flash_at45dbxx.flash_device, flash_device_name,
|
||||
RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
17
components/drivers/spi/spi_flash_at45dbxx.h
Normal file
17
components/drivers/spi/spi_flash_at45dbxx.h
Normal file
@@ -0,0 +1,17 @@
|
||||
#ifndef SPI_FLASH_AT45DBXX_H_INCLUDED
|
||||
#define SPI_FLASH_AT45DBXX_H_INCLUDED
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/spi.h>
|
||||
|
||||
struct spi_flash_at45dbxx
|
||||
{
|
||||
struct rt_device flash_device;
|
||||
struct rt_device_blk_geometry geometry;
|
||||
struct rt_spi_device * rt_spi_device;
|
||||
};
|
||||
|
||||
extern rt_err_t at45dbxx_init(const char * flash_device_name, const char * spi_device_name);
|
||||
|
||||
|
||||
#endif // SPI_FLASH_AT45DBXX_H_INCLUDED
|
||||
346
components/drivers/spi/spi_flash_sst25vfxx.c
Normal file
346
components/drivers/spi/spi_flash_sst25vfxx.c
Normal file
@@ -0,0 +1,346 @@
|
||||
/*
|
||||
* File : rtdef.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-16 aozima the first version
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include "spi_flash_sst25vfxx.h"
|
||||
|
||||
#define FLASH_DEBUG
|
||||
|
||||
#ifdef FLASH_DEBUG
|
||||
#define FLASH_TRACE rt_kprintf
|
||||
#else
|
||||
#define FLASH_TRACE(...)
|
||||
#endif /* #ifdef FLASH_DEBUG */
|
||||
|
||||
/* JEDEC Manufacturer¡¯s ID */
|
||||
#define MF_ID (0xBF)
|
||||
/* JEDEC Device ID : Memory Type */
|
||||
#define MT_ID (0x25)
|
||||
/* JEDEC Device ID: Memory Capacity */
|
||||
#define MC_ID_SST25VF020B (0x8C) /* 2Mbit */
|
||||
#define MC_ID_SST25VF040B (0x8D) /* 4Mbit */
|
||||
#define MC_ID_SST25VF080B (0x8E) /* 8Mbit */
|
||||
#define MC_ID_SST25VF016B (0x41) /* 16Mbit */
|
||||
#define MC_ID_SST25VF032B (0x4A) /* 32Mbit */
|
||||
#define MC_ID_SST25VF064C (0x4B) /* 64Mbit */
|
||||
|
||||
/* command list */
|
||||
#define CMD_RDSR (0x05)
|
||||
#define CMD_WRSR (0x01)
|
||||
#define CMD_EWSR (0x50)
|
||||
#define CMD_WRDI (0x04)
|
||||
#define CMD_WREN (0x06)
|
||||
#define CMD_READ (0x03)
|
||||
#define CMD_FAST_READ (0x0B)
|
||||
#define CMD_BP (0x02)
|
||||
#define CMD_AAIP (0xAD)
|
||||
#define CMD_ERASE_4K (0x20)
|
||||
#define CMD_ERASE_32K (0x52)
|
||||
#define CMD_ERASE_64K (0xD8)
|
||||
#define CMD_ERASE_full (0xC7)
|
||||
#define CMD_JEDEC_ID (0x9F)
|
||||
#define CMD_EBSY (0x70)
|
||||
#define CMD_DBSY (0x80)
|
||||
|
||||
#define DUMMY (0xFF)
|
||||
|
||||
static struct spi_flash_sst25vfxx spi_flash_sst25vfxx;
|
||||
|
||||
static uint8_t sst25vfxx_read_status(struct spi_flash_sst25vfxx * spi_flash)
|
||||
{
|
||||
return rt_spi_sendrecv8(spi_flash->rt_spi_device, CMD_RDSR);
|
||||
}
|
||||
|
||||
static void sst25vfxx_wait_busy(struct spi_flash_sst25vfxx * spi_flash)
|
||||
{
|
||||
while( sst25vfxx_read_status(spi_flash) & (0x01));
|
||||
}
|
||||
|
||||
/** \brief write N page on [page]
|
||||
*
|
||||
* \param page uint32_t unit : byte (4096 * N,1 page = 4096byte)
|
||||
* \param buffer const uint8_t*
|
||||
* \param size uint32_t unit : byte ( 4096*N )
|
||||
* \return uint32_t
|
||||
*
|
||||
*/
|
||||
static uint32_t sst25vfxx_page_write(struct spi_flash_sst25vfxx * spi_flash, uint32_t page, const uint8_t * buffer, uint32_t size)
|
||||
{
|
||||
uint32_t index;
|
||||
uint32_t need_wirte = size;
|
||||
uint8_t send_buffer[6];
|
||||
|
||||
page &= ~0xFFF; // page size = 4096byte
|
||||
|
||||
send_buffer[0] = CMD_WREN;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_ERASE_4K;
|
||||
send_buffer[1] = (page >> 16);
|
||||
send_buffer[2] = (page >> 8);
|
||||
send_buffer[3] = (page);
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 4);
|
||||
|
||||
sst25vfxx_wait_busy(spi_flash); // wait erase done.
|
||||
|
||||
send_buffer[0] = CMD_WREN;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_AAIP;
|
||||
send_buffer[1] = (uint8_t)(page >> 16);
|
||||
send_buffer[2] = (uint8_t)(page >> 8);
|
||||
send_buffer[3] = (uint8_t)(page);
|
||||
send_buffer[4] = *buffer++;
|
||||
send_buffer[5] = *buffer++;
|
||||
need_wirte -= 2;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 6);
|
||||
|
||||
sst25vfxx_wait_busy(spi_flash);
|
||||
|
||||
for(index=0; index < need_wirte/2; index++)
|
||||
{
|
||||
send_buffer[0] = CMD_AAIP;
|
||||
send_buffer[1] = *buffer++;
|
||||
send_buffer[2] = *buffer++;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 3);
|
||||
sst25vfxx_wait_busy(spi_flash);
|
||||
}
|
||||
|
||||
send_buffer[0] = CMD_WRDI;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 1);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/* RT-Thread device interface */
|
||||
static rt_err_t sst25vfxx_flash_init(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t sst25vfxx_flash_open(rt_device_t dev, rt_uint16_t oflag)
|
||||
{
|
||||
rt_err_t result;
|
||||
uint8_t send_buffer[2];
|
||||
struct spi_flash_sst25vfxx * spi_flash = (struct spi_flash_sst25vfxx *)dev;
|
||||
|
||||
/* lock spi flash */
|
||||
result = rt_mutex_take(&(spi_flash->lock), RT_WAITING_FOREVER);
|
||||
if(result != RT_EOK)
|
||||
{
|
||||
return result;
|
||||
}
|
||||
|
||||
send_buffer[0] = CMD_DBSY;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_EWSR;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_WRSR;
|
||||
send_buffer[1] = 0;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 2);
|
||||
|
||||
/* release lock */
|
||||
rt_mutex_release(&(spi_flash->lock));
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t sst25vfxx_flash_close(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t sst25vfxx_flash_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||
{
|
||||
struct spi_flash_sst25vfxx * spi_flash;
|
||||
|
||||
spi_flash = (struct spi_flash_sst25vfxx *)dev;
|
||||
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
|
||||
if (cmd == RT_DEVICE_CTRL_BLK_GETGEOME)
|
||||
{
|
||||
struct rt_device_blk_geometry *geometry;
|
||||
|
||||
geometry = (struct rt_device_blk_geometry *)args;
|
||||
if (geometry == RT_NULL) return -RT_ERROR;
|
||||
|
||||
geometry->bytes_per_sector = spi_flash->geometry.bytes_per_sector;
|
||||
geometry->sector_count = spi_flash->geometry.sector_count;
|
||||
geometry->block_size = spi_flash->geometry.block_size;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_size_t sst25vfxx_flash_read(rt_device_t dev, rt_off_t pos, void* buffer, rt_size_t size)
|
||||
{
|
||||
rt_err_t result;
|
||||
uint8_t send_buffer[4];
|
||||
struct spi_flash_sst25vfxx * spi_flash = (struct spi_flash_sst25vfxx *)dev;
|
||||
uint32_t offset = pos * spi_flash->geometry.bytes_per_sector;
|
||||
|
||||
/* lock spi flash */
|
||||
result = rt_mutex_take(&(spi_flash->lock), RT_WAITING_FOREVER);
|
||||
if(result != RT_EOK)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
send_buffer[0] = CMD_WRDI;
|
||||
rt_spi_send(spi_flash->rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_READ;
|
||||
send_buffer[1] = (uint8_t)(offset>>16);
|
||||
send_buffer[2] = (uint8_t)(offset>>8);
|
||||
send_buffer[3] = (uint8_t)(offset);
|
||||
rt_spi_send_then_recv(spi_flash->rt_spi_device, send_buffer, 4, buffer, size * spi_flash->geometry.bytes_per_sector);
|
||||
|
||||
/* release lock */
|
||||
rt_mutex_release(&(spi_flash->lock));
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t sst25vfxx_flash_write(rt_device_t dev, rt_off_t pos, const void* buffer, rt_size_t size)
|
||||
{
|
||||
uint32_t i;
|
||||
rt_err_t result;
|
||||
const uint8_t * write_buffer = buffer;
|
||||
struct spi_flash_sst25vfxx * spi_flash = (struct spi_flash_sst25vfxx *)dev;
|
||||
|
||||
/* lock spi flash */
|
||||
result = rt_mutex_take(&(spi_flash->lock), RT_WAITING_FOREVER);
|
||||
if(result != RT_EOK)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
for(i=0; i<size; i++)
|
||||
{
|
||||
sst25vfxx_page_write(spi_flash,
|
||||
(pos + i) * spi_flash->geometry.bytes_per_sector,
|
||||
write_buffer,
|
||||
spi_flash->geometry.bytes_per_sector);
|
||||
write_buffer += spi_flash->geometry.bytes_per_sector;
|
||||
}
|
||||
|
||||
/* release lock */
|
||||
rt_mutex_release(&(spi_flash->lock));
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
rt_err_t sst25vfxx_init(const char * flash_device_name, const char * spi_device_name)
|
||||
{
|
||||
struct rt_spi_device * rt_spi_device;
|
||||
struct spi_flash_sst25vfxx * spi_flash = &spi_flash_sst25vfxx;
|
||||
|
||||
rt_spi_device = (struct rt_spi_device *)rt_device_find(spi_device_name);
|
||||
if(rt_spi_device == RT_NULL)
|
||||
{
|
||||
FLASH_TRACE("spi device %s not found!\r\n", spi_device_name);
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
spi_flash->rt_spi_device = rt_spi_device;
|
||||
|
||||
/* config spi */
|
||||
{
|
||||
struct rt_spi_configuration cfg;
|
||||
cfg.data_width = 8;
|
||||
cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible: Mode 0 and Mode 3 */
|
||||
cfg.max_hz = 50000000; /* 50M */
|
||||
rt_spi_configure(spi_flash->rt_spi_device, &cfg);
|
||||
}
|
||||
|
||||
/* init flash */
|
||||
{
|
||||
rt_uint8_t cmd;
|
||||
rt_uint8_t id_recv[3];
|
||||
|
||||
cmd = CMD_WRDI;
|
||||
rt_spi_send(spi_flash->rt_spi_device, &cmd, 1);
|
||||
|
||||
/* read flash id */
|
||||
cmd = CMD_JEDEC_ID;
|
||||
rt_spi_send_then_recv(spi_flash->rt_spi_device, &cmd, 1, id_recv, 3);
|
||||
|
||||
if(id_recv[0] != MF_ID || id_recv[1] != MT_ID)
|
||||
{
|
||||
FLASH_TRACE("Manufacturer¡¯s ID or Memory Type error!\r\n");
|
||||
FLASH_TRACE("JEDEC Read-ID Data : %02X %02X %02X\r\n", id_recv[0], id_recv[1], id_recv[2]);
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
|
||||
spi_flash->geometry.bytes_per_sector = 4096;
|
||||
spi_flash->geometry.block_size = 4096; /* block erase: 4k */
|
||||
|
||||
if(id_recv[2] == MC_ID_SST25VF020B)
|
||||
{
|
||||
FLASH_TRACE("SST25VF020B detection\r\n");
|
||||
spi_flash->geometry.sector_count = 64;
|
||||
}
|
||||
else if(id_recv[2] == MC_ID_SST25VF040B)
|
||||
{
|
||||
FLASH_TRACE("SST25VF040B detection\r\n");
|
||||
spi_flash->geometry.sector_count = 128;
|
||||
}
|
||||
else if(id_recv[2] == MC_ID_SST25VF080B)
|
||||
{
|
||||
FLASH_TRACE("SST25VF080B detection\r\n");
|
||||
spi_flash->geometry.sector_count = 256;
|
||||
}
|
||||
else if(id_recv[2] == MC_ID_SST25VF016B)
|
||||
{
|
||||
FLASH_TRACE("SST25VF016B detection\r\n");
|
||||
spi_flash->geometry.sector_count = 512;
|
||||
}
|
||||
else if(id_recv[2] == MC_ID_SST25VF032B)
|
||||
{
|
||||
FLASH_TRACE("SST25VF032B detection\r\n");
|
||||
spi_flash->geometry.sector_count = 1024;
|
||||
}
|
||||
else if(id_recv[2] == MC_ID_SST25VF064C)
|
||||
{
|
||||
FLASH_TRACE("SST25VF064C detection\r\n");
|
||||
spi_flash->geometry.sector_count = 2048;
|
||||
}
|
||||
else
|
||||
{
|
||||
FLASH_TRACE("Memory Capacity error!\r\n");
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
}
|
||||
|
||||
/* initialize mutex lock */
|
||||
rt_mutex_init(&spi_flash->lock, flash_device_name, RT_IPC_FLAG_PRIO);
|
||||
|
||||
/* register device */
|
||||
spi_flash->flash_device.type = RT_Device_Class_Block;
|
||||
spi_flash->flash_device.init = sst25vfxx_flash_init;
|
||||
spi_flash->flash_device.open = sst25vfxx_flash_open;
|
||||
spi_flash->flash_device.close = sst25vfxx_flash_close;
|
||||
spi_flash->flash_device.read = sst25vfxx_flash_read;
|
||||
spi_flash->flash_device.write = sst25vfxx_flash_write;
|
||||
spi_flash->flash_device.control = sst25vfxx_flash_control;
|
||||
/* no private */
|
||||
spi_flash->flash_device.user_data = RT_NULL;
|
||||
|
||||
rt_device_register(&spi_flash->flash_device, flash_device_name,
|
||||
RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
32
components/drivers/spi/spi_flash_sst25vfxx.h
Normal file
32
components/drivers/spi/spi_flash_sst25vfxx.h
Normal file
@@ -0,0 +1,32 @@
|
||||
/*
|
||||
* File : rtdef.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-16 aozima the first version
|
||||
*/
|
||||
|
||||
#ifndef SPI_FLASH_SST25VFXX_H_INCLUDED
|
||||
#define SPI_FLASH_SST25VFXX_H_INCLUDED
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/spi.h>
|
||||
|
||||
struct spi_flash_sst25vfxx
|
||||
{
|
||||
struct rt_device flash_device;
|
||||
struct rt_device_blk_geometry geometry;
|
||||
struct rt_spi_device * rt_spi_device;
|
||||
struct rt_mutex lock;
|
||||
};
|
||||
|
||||
extern rt_err_t sst25vfxx_init(const char * flash_device_name, const char * spi_device_name);
|
||||
|
||||
|
||||
#endif // SPI_FLASH_SST25VFXX_H_INCLUDED
|
||||
371
components/drivers/spi/spi_flash_w25qxx.c
Normal file
371
components/drivers/spi/spi_flash_w25qxx.c
Normal file
@@ -0,0 +1,371 @@
|
||||
/*
|
||||
* File : spi_flash_w25qxx.c
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-16 aozima the first version
|
||||
* 2012-05-06 aozima can page write.
|
||||
* 2012-08-23 aozima add flash lock.
|
||||
* 2012-08-24 aozima fixed write status register BUG.
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include "spi_flash_w25qxx.h"
|
||||
|
||||
#define FLASH_DEBUG
|
||||
|
||||
#ifdef FLASH_DEBUG
|
||||
#define FLASH_TRACE rt_kprintf
|
||||
#else
|
||||
#define FLASH_TRACE(...)
|
||||
#endif /* #ifdef FLASH_DEBUG */
|
||||
|
||||
#define PAGE_SIZE 4096
|
||||
|
||||
/* JEDEC Manufacturer¡¯s ID */
|
||||
#define MF_ID (0xEF)
|
||||
/* JEDEC Device ID: Memory type and Capacity */
|
||||
#define MTC_W25Q16_BV_CL_CV (0x4015) /* W25Q16BV W25Q16CL W25Q16CV */
|
||||
#define MTC_W25Q16_DW (0x6015) /* W25Q16DW */
|
||||
#define MTC_W25Q32_BV (0x4016) /* W25Q32BV */
|
||||
#define MTC_W25Q32_DW (0x6016) /* W25Q32DW */
|
||||
#define MTC_W25Q64_BV_CV (0x4017) /* W25Q64BV W25Q64CV */
|
||||
#define MTC_W25Q64_DW (0x4017) /* W25Q64DW */
|
||||
#define MTC_W25Q128_BV (0x4018) /* W25Q128BV */
|
||||
#define MTC_W25Q256_FV (TBD) /* W25Q256FV */
|
||||
|
||||
/* command list */
|
||||
#define CMD_WRSR (0x01) /* Write Status Register */
|
||||
#define CMD_PP (0x02) /* Page Program */
|
||||
#define CMD_READ (0x03) /* Read Data */
|
||||
#define CMD_WRDI (0x04) /* Write Disable */
|
||||
#define CMD_RDSR1 (0x05) /* Read Status Register-1 */
|
||||
#define CMD_WREN (0x06) /* Write Enable */
|
||||
#define CMD_FAST_READ (0x0B) /* Fast Read */
|
||||
#define CMD_ERASE_4K (0x20) /* Sector Erase:4K */
|
||||
#define CMD_RDSR2 (0x35) /* Read Status Register-2 */
|
||||
#define CMD_ERASE_32K (0x52) /* 32KB Block Erase */
|
||||
#define CMD_JEDEC_ID (0x9F) /* Read JEDEC ID */
|
||||
#define CMD_ERASE_full (0xC7) /* Chip Erase */
|
||||
#define CMD_ERASE_64K (0xD8) /* 64KB Block Erase */
|
||||
|
||||
#define DUMMY (0xFF)
|
||||
|
||||
static struct spi_flash_device spi_flash_device;
|
||||
|
||||
static void flash_lock(struct spi_flash_device * flash_device)
|
||||
{
|
||||
rt_mutex_take(&flash_device->lock, RT_WAITING_FOREVER);
|
||||
}
|
||||
|
||||
static void flash_unlock(struct spi_flash_device * flash_device)
|
||||
{
|
||||
rt_mutex_release(&flash_device->lock);
|
||||
}
|
||||
|
||||
static uint8_t w25qxx_read_status(void)
|
||||
{
|
||||
return rt_spi_sendrecv8(spi_flash_device.rt_spi_device, CMD_RDSR1);
|
||||
}
|
||||
|
||||
static void w25qxx_wait_busy(void)
|
||||
{
|
||||
while( w25qxx_read_status() & (0x01));
|
||||
}
|
||||
|
||||
/** \brief read [size] byte from [offset] to [buffer]
|
||||
*
|
||||
* \param offset uint32_t unit : byte
|
||||
* \param buffer uint8_t*
|
||||
* \param size uint32_t unit : byte
|
||||
* \return uint32_t byte for read
|
||||
*
|
||||
*/
|
||||
static uint32_t w25qxx_read(uint32_t offset, uint8_t * buffer, uint32_t size)
|
||||
{
|
||||
uint8_t send_buffer[4];
|
||||
|
||||
send_buffer[0] = CMD_WRDI;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_READ;
|
||||
send_buffer[1] = (uint8_t)(offset>>16);
|
||||
send_buffer[2] = (uint8_t)(offset>>8);
|
||||
send_buffer[3] = (uint8_t)(offset);
|
||||
|
||||
rt_spi_send_then_recv(spi_flash_device.rt_spi_device,
|
||||
send_buffer, 4,
|
||||
buffer, size);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
/** \brief write N page on [page]
|
||||
*
|
||||
* \param page_addr uint32_t unit : byte (4096 * N,1 page = 4096byte)
|
||||
* \param buffer const uint8_t*
|
||||
* \return uint32_t
|
||||
*
|
||||
*/
|
||||
uint32_t w25qxx_page_write(uint32_t page_addr, const uint8_t* buffer)
|
||||
{
|
||||
uint32_t index;
|
||||
uint8_t send_buffer[4];
|
||||
|
||||
RT_ASSERT((page_addr&0xFF) == 0); /* page addr must align to 256byte. */
|
||||
|
||||
send_buffer[0] = CMD_WREN;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_ERASE_4K;
|
||||
send_buffer[1] = (page_addr >> 16);
|
||||
send_buffer[2] = (page_addr >> 8);
|
||||
send_buffer[3] = (page_addr);
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 4);
|
||||
|
||||
w25qxx_wait_busy(); // wait erase done.
|
||||
|
||||
for(index=0; index < (PAGE_SIZE / 256); index++)
|
||||
{
|
||||
send_buffer[0] = CMD_WREN;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_PP;
|
||||
send_buffer[1] = (uint8_t)(page_addr >> 16);
|
||||
send_buffer[2] = (uint8_t)(page_addr >> 8);
|
||||
send_buffer[3] = (uint8_t)(page_addr);
|
||||
|
||||
rt_spi_send_then_send(spi_flash_device.rt_spi_device,
|
||||
send_buffer,
|
||||
4,
|
||||
buffer,
|
||||
256);
|
||||
|
||||
buffer += 256;
|
||||
page_addr += 256;
|
||||
w25qxx_wait_busy();
|
||||
}
|
||||
|
||||
send_buffer[0] = CMD_WRDI;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 1);
|
||||
|
||||
return PAGE_SIZE;
|
||||
}
|
||||
|
||||
/* RT-Thread device interface */
|
||||
static rt_err_t w25qxx_flash_init(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t w25qxx_flash_open(rt_device_t dev, rt_uint16_t oflag)
|
||||
{
|
||||
uint8_t send_buffer[3];
|
||||
|
||||
flash_lock((struct spi_flash_device *)dev);
|
||||
|
||||
send_buffer[0] = CMD_WREN;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 1);
|
||||
|
||||
send_buffer[0] = CMD_WRSR;
|
||||
send_buffer[1] = 0;
|
||||
send_buffer[2] = 0;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, send_buffer, 3);
|
||||
|
||||
w25qxx_wait_busy();
|
||||
|
||||
flash_unlock((struct spi_flash_device *)dev);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t w25qxx_flash_close(rt_device_t dev)
|
||||
{
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_err_t w25qxx_flash_control(rt_device_t dev, rt_uint8_t cmd, void *args)
|
||||
{
|
||||
RT_ASSERT(dev != RT_NULL);
|
||||
|
||||
if (cmd == RT_DEVICE_CTRL_BLK_GETGEOME)
|
||||
{
|
||||
struct rt_device_blk_geometry *geometry;
|
||||
|
||||
geometry = (struct rt_device_blk_geometry *)args;
|
||||
if (geometry == RT_NULL) return -RT_ERROR;
|
||||
|
||||
geometry->bytes_per_sector = spi_flash_device.geometry.bytes_per_sector;
|
||||
geometry->sector_count = spi_flash_device.geometry.sector_count;
|
||||
geometry->block_size = spi_flash_device.geometry.block_size;
|
||||
}
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
|
||||
static rt_size_t w25qxx_flash_read(rt_device_t dev,
|
||||
rt_off_t pos,
|
||||
void* buffer,
|
||||
rt_size_t size)
|
||||
{
|
||||
flash_lock((struct spi_flash_device *)dev);
|
||||
|
||||
w25qxx_read(pos*spi_flash_device.geometry.bytes_per_sector,
|
||||
buffer,
|
||||
size*spi_flash_device.geometry.bytes_per_sector);
|
||||
|
||||
flash_unlock((struct spi_flash_device *)dev);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
static rt_size_t w25qxx_flash_write(rt_device_t dev,
|
||||
rt_off_t pos,
|
||||
const void* buffer,
|
||||
rt_size_t size)
|
||||
{
|
||||
rt_size_t i = 0;
|
||||
rt_size_t block = size;
|
||||
const uint8_t * ptr = buffer;
|
||||
|
||||
flash_lock((struct spi_flash_device *)dev);
|
||||
|
||||
while(block--)
|
||||
{
|
||||
w25qxx_page_write((pos + i)*spi_flash_device.geometry.bytes_per_sector,
|
||||
ptr);
|
||||
ptr += PAGE_SIZE;
|
||||
i++;
|
||||
}
|
||||
|
||||
flash_unlock((struct spi_flash_device *)dev);
|
||||
|
||||
return size;
|
||||
}
|
||||
|
||||
rt_err_t w25qxx_init(const char * flash_device_name, const char * spi_device_name)
|
||||
{
|
||||
struct rt_spi_device * rt_spi_device;
|
||||
|
||||
/* initialize mutex */
|
||||
if (rt_mutex_init(&spi_flash_device.lock, spi_device_name, RT_IPC_FLAG_FIFO) != RT_EOK)
|
||||
{
|
||||
rt_kprintf("init sd lock mutex failed\n");
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
|
||||
rt_spi_device = (struct rt_spi_device *)rt_device_find(spi_device_name);
|
||||
if(rt_spi_device == RT_NULL)
|
||||
{
|
||||
FLASH_TRACE("spi device %s not found!\r\n", spi_device_name);
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
spi_flash_device.rt_spi_device = rt_spi_device;
|
||||
|
||||
/* config spi */
|
||||
{
|
||||
struct rt_spi_configuration cfg;
|
||||
cfg.data_width = 8;
|
||||
cfg.mode = RT_SPI_MODE_0 | RT_SPI_MSB; /* SPI Compatible: Mode 0 and Mode 3 */
|
||||
cfg.max_hz = 50 * 1000 * 1000; /* 50M */
|
||||
rt_spi_configure(spi_flash_device.rt_spi_device, &cfg);
|
||||
}
|
||||
|
||||
/* init flash */
|
||||
{
|
||||
rt_uint8_t cmd;
|
||||
rt_uint8_t id_recv[3];
|
||||
uint16_t memory_type_capacity;
|
||||
|
||||
flash_lock(&spi_flash_device);
|
||||
|
||||
cmd = 0xFF; /* reset SPI FLASH, cancel all cmd in processing. */
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, &cmd, 1);
|
||||
|
||||
cmd = CMD_WRDI;
|
||||
rt_spi_send(spi_flash_device.rt_spi_device, &cmd, 1);
|
||||
|
||||
/* read flash id */
|
||||
cmd = CMD_JEDEC_ID;
|
||||
rt_spi_send_then_recv(spi_flash_device.rt_spi_device, &cmd, 1, id_recv, 3);
|
||||
|
||||
flash_unlock(&spi_flash_device);
|
||||
|
||||
if(id_recv[0] != MF_ID)
|
||||
{
|
||||
FLASH_TRACE("Manufacturers ID error!\r\n");
|
||||
FLASH_TRACE("JEDEC Read-ID Data : %02X %02X %02X\r\n", id_recv[0], id_recv[1], id_recv[2]);
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
|
||||
spi_flash_device.geometry.bytes_per_sector = 4096;
|
||||
spi_flash_device.geometry.block_size = 4096; /* block erase: 4k */
|
||||
|
||||
/* get memory type and capacity */
|
||||
memory_type_capacity = id_recv[1];
|
||||
memory_type_capacity = (memory_type_capacity << 8) | id_recv[2];
|
||||
|
||||
if(memory_type_capacity == MTC_W25Q128_BV)
|
||||
{
|
||||
FLASH_TRACE("W25Q128BV detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 4096;
|
||||
}
|
||||
else if(memory_type_capacity == MTC_W25Q64_BV_CV)
|
||||
{
|
||||
FLASH_TRACE("W25Q64BV or W25Q64CV detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 2048;
|
||||
}
|
||||
else if(memory_type_capacity == MTC_W25Q64_DW)
|
||||
{
|
||||
FLASH_TRACE("W25Q64DW detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 2048;
|
||||
}
|
||||
else if(memory_type_capacity == MTC_W25Q32_BV)
|
||||
{
|
||||
FLASH_TRACE("W25Q32BV detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 1024;
|
||||
}
|
||||
else if(memory_type_capacity == MTC_W25Q32_DW)
|
||||
{
|
||||
FLASH_TRACE("W25Q32DW detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 1024;
|
||||
}
|
||||
else if(memory_type_capacity == MTC_W25Q16_BV_CL_CV)
|
||||
{
|
||||
FLASH_TRACE("W25Q16BV or W25Q16CL or W25Q16CV detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 512;
|
||||
}
|
||||
else if(memory_type_capacity == MTC_W25Q16_DW)
|
||||
{
|
||||
FLASH_TRACE("W25Q16DW detection\r\n");
|
||||
spi_flash_device.geometry.sector_count = 512;
|
||||
}
|
||||
else
|
||||
{
|
||||
FLASH_TRACE("Memory Capacity error!\r\n");
|
||||
return -RT_ENOSYS;
|
||||
}
|
||||
}
|
||||
|
||||
/* register device */
|
||||
spi_flash_device.flash_device.type = RT_Device_Class_Block;
|
||||
spi_flash_device.flash_device.init = w25qxx_flash_init;
|
||||
spi_flash_device.flash_device.open = w25qxx_flash_open;
|
||||
spi_flash_device.flash_device.close = w25qxx_flash_close;
|
||||
spi_flash_device.flash_device.read = w25qxx_flash_read;
|
||||
spi_flash_device.flash_device.write = w25qxx_flash_write;
|
||||
spi_flash_device.flash_device.control = w25qxx_flash_control;
|
||||
/* no private */
|
||||
spi_flash_device.flash_device.user_data = RT_NULL;
|
||||
|
||||
rt_device_register(&spi_flash_device.flash_device, flash_device_name,
|
||||
RT_DEVICE_FLAG_RDWR | RT_DEVICE_FLAG_STANDALONE);
|
||||
|
||||
return RT_EOK;
|
||||
}
|
||||
34
components/drivers/spi/spi_flash_w25qxx.h
Normal file
34
components/drivers/spi/spi_flash_w25qxx.h
Normal file
@@ -0,0 +1,34 @@
|
||||
/*
|
||||
* File : spi_flash_w25qxx.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* COPYRIGHT (C) 2006 - 2011, RT-Thread Development Team
|
||||
*
|
||||
* The license and distribution terms for this file may be
|
||||
* found in the file LICENSE in this distribution or at
|
||||
* http://www.rt-thread.org/license/LICENSE
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2011-12-16 aozima the first version
|
||||
* 2012-08-23 aozima add flash lock.
|
||||
*/
|
||||
|
||||
#ifndef SPI_FLASH_W25QXX_H_INCLUDED
|
||||
#define SPI_FLASH_W25QXX_H_INCLUDED
|
||||
|
||||
#include <rtthread.h>
|
||||
#include <drivers/spi.h>
|
||||
|
||||
struct spi_flash_device
|
||||
{
|
||||
struct rt_device flash_device;
|
||||
struct rt_device_blk_geometry geometry;
|
||||
struct rt_spi_device * rt_spi_device;
|
||||
struct rt_mutex lock;
|
||||
};
|
||||
|
||||
extern rt_err_t w25qxx_init(const char * flash_device_name,
|
||||
const char * spi_device_name);
|
||||
|
||||
|
||||
#endif // SPI_FLASH_W25QXX_H_INCLUDED
|
||||
590
components/drivers/spi/spi_wifi_rw009.c
Normal file
590
components/drivers/spi/spi_wifi_rw009.c
Normal file
File diff suppressed because it is too large
Load Diff
123
components/drivers/spi/spi_wifi_rw009.h
Normal file
123
components/drivers/spi/spi_wifi_rw009.h
Normal file
@@ -0,0 +1,123 @@
|
||||
/*
|
||||
* File : spi_wifi_rw009.h
|
||||
* This file is part of RT-Thread RTOS
|
||||
* Copyright by Shanghai Real-Thread Electronic Technology Co.,Ltd
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License as published by
|
||||
* the Free Software Foundation; either version 2 of the License, or
|
||||
* (at your option) any later version.
|
||||
*
|
||||
* This program is distributed in the hope that it will be useful,
|
||||
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||
* GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License along
|
||||
* with this program; if not, write to the Free Software Foundation, Inc.,
|
||||
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
|
||||
*
|
||||
* Change Logs:
|
||||
* Date Author Notes
|
||||
* 2014-07-31 aozima the first version
|
||||
*/
|
||||
|
||||
#ifndef SPI_WIFI_H_INCLUDED
|
||||
#define SPI_WIFI_H_INCLUDED
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
// little-endian
|
||||
struct cmd_request
|
||||
{
|
||||
uint32_t flag;
|
||||
uint32_t M2S_len; // master to slave data len.
|
||||
uint32_t magic1;
|
||||
uint32_t magic2;
|
||||
};
|
||||
|
||||
#define CMD_MAGIC1 (0x67452301)
|
||||
#define CMD_MAGIC2 (0xEFCDAB89)
|
||||
|
||||
#define CMD_FLAG_MRDY (0x01)
|
||||
|
||||
// little-endian
|
||||
struct response
|
||||
{
|
||||
uint32_t flag;
|
||||
uint32_t S2M_len; // slave to master data len.
|
||||
uint32_t magic1;
|
||||
uint32_t magic2;
|
||||
};
|
||||
|
||||
#define RESP_FLAG_SRDY (0x01)
|
||||
#define RESP_MAGIC1 (0x98BADCFE)
|
||||
#define RESP_MAGIC2 (0x10325476)
|
||||
|
||||
/* spi slave configure. */
|
||||
#define MAX_DATA_LEN 1520
|
||||
#define SPI_TX_POOL_SIZE 2
|
||||
|
||||
// align check
|
||||
#if (MAX_DATA_LEN & 0x03) != 0
|
||||
#error MAX_DATA_LEN must ALIGN to 4byte!
|
||||
#endif
|
||||
|
||||
typedef enum
|
||||
{
|
||||
data_type_eth_data = 0,
|
||||
data_type_cmd,
|
||||
data_type_resp,
|
||||
}
|
||||
app_data_type_typedef;
|
||||
|
||||
struct spi_data_packet
|
||||
{
|
||||
uint32_t data_len;
|
||||
uint32_t data_type;
|
||||
char buffer[MAX_DATA_LEN];
|
||||
};
|
||||
|
||||
struct spi_wifi_cmd
|
||||
{
|
||||
uint32_t cmd;
|
||||
char buffer[128];
|
||||
};
|
||||
|
||||
struct spi_wifi_resp
|
||||
{
|
||||
uint32_t cmd;
|
||||
char buffer[128];
|
||||
};
|
||||
|
||||
#define SPI_WIFI_CMD_INIT 128 //wait
|
||||
#define SPI_WIFI_CMD_SCAN 129 //no wait
|
||||
#define SPI_WIFI_CMD_JOIN 130 //no wait
|
||||
|
||||
/* porting */
|
||||
extern void spi_wifi_hw_init(void);
|
||||
extern void spi_wifi_int_cmd(rt_bool_t cmd);
|
||||
extern rt_bool_t spi_wifi_is_busy(void);
|
||||
|
||||
/* tools */
|
||||
#define node_entry(node, type, member) \
|
||||
((type *)((char *)(node) - (unsigned long)(&((type *)0)->member)))
|
||||
#define member_offset(type, member) \
|
||||
((unsigned long)(&((type *)0)->member))
|
||||
|
||||
#define SSID_NAME_LENGTH_MAX (32)
|
||||
#define PASSWORD_LENGTH_MAX (32)
|
||||
|
||||
struct cmd_join
|
||||
{
|
||||
char ssid[SSID_NAME_LENGTH_MAX];
|
||||
char passwd[PASSWORD_LENGTH_MAX];
|
||||
|
||||
uint8_t bssid[8]; // 6byte + 2byte PAD.
|
||||
|
||||
uint32_t channel;
|
||||
uint32_t security;
|
||||
};
|
||||
|
||||
|
||||
#endif // SPI_WIFI_H_INCLUDED
|
||||
2
components/external/libpng/pngconf.h
vendored
2
components/external/libpng/pngconf.h
vendored
@@ -24,10 +24,10 @@
|
||||
#define PNG_MAX_MALLOC_64K
|
||||
#define PNG_NO_STDIO
|
||||
#define PNG_NO_ERROR_NUMBERS
|
||||
#define PNG_NO_WRITE_SUPPORTED
|
||||
#define PNG_ABORT() do { rt_kprintf("libpng abort.\n"); } while (0)
|
||||
|
||||
#ifndef RT_USING_NEWLIB
|
||||
#define PNG_NO_WRITE_SUPPORTED
|
||||
#define PNG_NO_SETJMP_SUPPORTED
|
||||
#define malloc rtgui_malloc
|
||||
#define free rtgui_free
|
||||
|
||||
@@ -3,6 +3,14 @@
|
||||
#include <sys/time.h>
|
||||
#include <rtthread.h>
|
||||
|
||||
#ifdef RT_USING_DFS
|
||||
#include <dfs_posix.h>
|
||||
#endif
|
||||
|
||||
#ifdef RT_USING_PTHREADS
|
||||
#include <pthread.h>
|
||||
#endif
|
||||
|
||||
/* Reentrant versions of system calls. */
|
||||
|
||||
int
|
||||
|
||||
@@ -79,8 +79,8 @@ _reswitch:
|
||||
STR R1, [R0]
|
||||
BX LR
|
||||
|
||||
/* R0 --> swith from thread stack
|
||||
* R1 --> swith to thread stack
|
||||
/* R0 --> switch from thread stack
|
||||
* R1 --> switch to thread stack
|
||||
* psr, pc, LR, R12, R3, R2, R1, R0 are pushed into [from] stack
|
||||
*/
|
||||
.global PendSV_Handler
|
||||
@@ -103,7 +103,7 @@ PendSV_Handler:
|
||||
LDR R0, =rt_interrupt_from_thread
|
||||
LDR R1, [R0]
|
||||
CMP R1, #0x00
|
||||
BEQ swtich_to_thread /* skip register save at the first time */
|
||||
BEQ switch_to_thread /* skip register save at the first time */
|
||||
|
||||
MRS R1, PSP /* get from thread stack pointer */
|
||||
|
||||
@@ -118,7 +118,7 @@ PendSV_Handler:
|
||||
MOV R6, R10
|
||||
MOV R7, R11
|
||||
STMIA R1!, {R4 - R7} /* push thread {R8 - R11} high register to thread stack */
|
||||
swtich_to_thread:
|
||||
switch_to_thread:
|
||||
LDR R1, =rt_interrupt_to_thread
|
||||
LDR R1, [R1]
|
||||
LDR R1, [R1] /* load thread stack pointer */
|
||||
|
||||
@@ -81,8 +81,8 @@ _reswitch
|
||||
STR r1, [r0]
|
||||
BX LR
|
||||
|
||||
; r0 --> swith from thread stack
|
||||
; r1 --> swith to thread stack
|
||||
; r0 --> switch from thread stack
|
||||
; r1 --> switch to thread stack
|
||||
; psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
EXPORT PendSV_Handler
|
||||
PendSV_Handler:
|
||||
@@ -104,7 +104,7 @@ PendSV_Handler:
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CMP r1, #0x00
|
||||
BEQ swtich_to_thread ; skip register save at the first time
|
||||
BEQ switch_to_thread ; skip register save at the first time
|
||||
|
||||
MRS r1, psp ; get from thread stack pointer
|
||||
|
||||
@@ -120,7 +120,7 @@ PendSV_Handler:
|
||||
MOV r7, r11
|
||||
STMIA r1!, {r4 - r7} ; push thread {r8 - r11} high register to thread stack
|
||||
|
||||
swtich_to_thread
|
||||
switch_to_thread
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] ; load thread stack pointer
|
||||
|
||||
@@ -85,8 +85,8 @@ _reswitch
|
||||
BX LR
|
||||
ENDP
|
||||
|
||||
; r0 --> swith from thread stack
|
||||
; r1 --> swith to thread stack
|
||||
; r0 --> switch from thread stack
|
||||
; r1 --> switch to thread stack
|
||||
; psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
PendSV_Handler PROC
|
||||
EXPORT PendSV_Handler
|
||||
@@ -108,7 +108,7 @@ PendSV_Handler PROC
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CMP r1, #0x00
|
||||
BEQ swtich_to_thread ; skip register save at the first time
|
||||
BEQ switch_to_thread ; skip register save at the first time
|
||||
|
||||
MRS r1, psp ; get from thread stack pointer
|
||||
|
||||
@@ -124,7 +124,7 @@ PendSV_Handler PROC
|
||||
MOV r7, r11
|
||||
STMIA r1!, {r4 - r7} ; push thread {r8 - r11} high register to thread stack
|
||||
|
||||
swtich_to_thread
|
||||
switch_to_thread
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] ; load thread stack pointer
|
||||
|
||||
@@ -80,8 +80,8 @@ _reswitch:
|
||||
STR R1, [R0]
|
||||
BX LR
|
||||
|
||||
/* R0 --> swith from thread stack
|
||||
* R1 --> swith to thread stack
|
||||
/* R0 --> switch from thread stack
|
||||
* R1 --> switch to thread stack
|
||||
* psr, pc, LR, R12, R3, R2, R1, R0 are pushed into [from] stack
|
||||
*/
|
||||
.global PendSV_Handler
|
||||
@@ -102,14 +102,14 @@ PendSV_Handler:
|
||||
|
||||
LDR R0, =rt_interrupt_from_thread
|
||||
LDR R1, [R0]
|
||||
CBZ R1, swtich_to_thread /* skip register save at the first time */
|
||||
CBZ R1, switch_to_thread /* skip register save at the first time */
|
||||
|
||||
MRS R1, PSP /* get from thread stack pointer */
|
||||
STMFD R1!, {R4 - R11} /* push R4 - R11 register */
|
||||
LDR R0, [R0]
|
||||
STR R1, [R0] /* update from thread stack pointer */
|
||||
|
||||
swtich_to_thread:
|
||||
switch_to_thread:
|
||||
LDR R1, =rt_interrupt_to_thread
|
||||
LDR R1, [R1]
|
||||
LDR R1, [R1] /* load thread stack pointer */
|
||||
|
||||
@@ -81,8 +81,8 @@ _reswitch
|
||||
STR r1, [r0]
|
||||
BX LR
|
||||
|
||||
; r0 --> swith from thread stack
|
||||
; r1 --> swith to thread stack
|
||||
; r0 --> switch from thread stack
|
||||
; r1 --> switch to thread stack
|
||||
; psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
EXPORT PendSV_Handler
|
||||
PendSV_Handler:
|
||||
@@ -102,14 +102,14 @@ PendSV_Handler:
|
||||
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CBZ r1, swtich_to_thread ; skip register save at the first time
|
||||
CBZ r1, switch_to_thread ; skip register save at the first time
|
||||
|
||||
MRS r1, psp ; get from thread stack pointer
|
||||
STMFD r1!, {r4 - r11} ; push r4 - r11 register
|
||||
LDR r0, [r0]
|
||||
STR r1, [r0] ; update from thread stack pointer
|
||||
|
||||
swtich_to_thread
|
||||
switch_to_thread
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] ; load thread stack pointer
|
||||
|
||||
@@ -84,8 +84,8 @@ _reswitch
|
||||
BX LR
|
||||
ENDP
|
||||
|
||||
; r0 --> swith from thread stack
|
||||
; r1 --> swith to thread stack
|
||||
; r0 --> switch from thread stack
|
||||
; r1 --> switch to thread stack
|
||||
; psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
PendSV_Handler PROC
|
||||
EXPORT PendSV_Handler
|
||||
@@ -105,14 +105,14 @@ PendSV_Handler PROC
|
||||
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CBZ r1, swtich_to_thread ; skip register save at the first time
|
||||
CBZ r1, switch_to_thread ; skip register save at the first time
|
||||
|
||||
MRS r1, psp ; get from thread stack pointer
|
||||
STMFD r1!, {r4 - r11} ; push r4 - r11 register
|
||||
LDR r0, [r0]
|
||||
STR r1, [r0] ; update from thread stack pointer
|
||||
|
||||
swtich_to_thread
|
||||
switch_to_thread
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] ; load thread stack pointer
|
||||
|
||||
@@ -82,8 +82,8 @@ _reswitch:
|
||||
STR r1, [r0]
|
||||
BX LR
|
||||
|
||||
/* r0 --> swith from thread stack
|
||||
* r1 --> swith to thread stack
|
||||
/* r0 --> switch from thread stack
|
||||
* r1 --> switch to thread stack
|
||||
* psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
*/
|
||||
.global PendSV_Handler
|
||||
@@ -104,7 +104,7 @@ PendSV_Handler:
|
||||
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CBZ r1, swtich_to_thread /* skip register save at the first time */
|
||||
CBZ r1, switch_to_thread /* skip register save at the first time */
|
||||
|
||||
MRS r1, psp /* get from thread stack pointer */
|
||||
|
||||
@@ -127,7 +127,7 @@ PendSV_Handler:
|
||||
LDR r0, [r0]
|
||||
STR r1, [r0] /* update from thread stack pointer */
|
||||
|
||||
swtich_to_thread:
|
||||
switch_to_thread:
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] /* load thread stack pointer */
|
||||
|
||||
@@ -82,8 +82,8 @@ _reswitch
|
||||
STR r1, [r0]
|
||||
BX LR
|
||||
|
||||
; r0 --> swith from thread stack
|
||||
; r1 --> swith to thread stack
|
||||
; r0 --> switch from thread stack
|
||||
; r1 --> switch to thread stack
|
||||
; psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
EXPORT PendSV_Handler
|
||||
PendSV_Handler:
|
||||
@@ -103,7 +103,7 @@ PendSV_Handler:
|
||||
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CBZ r1, swtich_to_thread ; skip register save at the first time
|
||||
CBZ r1, switch_to_thread ; skip register save at the first time
|
||||
|
||||
MRS r1, psp ; get from thread stack pointer
|
||||
|
||||
@@ -130,7 +130,7 @@ push_flag
|
||||
LDR r0, [r0]
|
||||
STR r1, [r0] ; update from thread stack pointer
|
||||
|
||||
swtich_to_thread
|
||||
switch_to_thread
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] ; load thread stack pointer
|
||||
|
||||
@@ -85,8 +85,8 @@ _reswitch
|
||||
BX LR
|
||||
ENDP
|
||||
|
||||
; r0 --> swith from thread stack
|
||||
; r1 --> swith to thread stack
|
||||
; r0 --> switch from thread stack
|
||||
; r1 --> switch to thread stack
|
||||
; psr, pc, lr, r12, r3, r2, r1, r0 are pushed into [from] stack
|
||||
PendSV_Handler PROC
|
||||
EXPORT PendSV_Handler
|
||||
@@ -106,7 +106,7 @@ PendSV_Handler PROC
|
||||
|
||||
LDR r0, =rt_interrupt_from_thread
|
||||
LDR r1, [r0]
|
||||
CBZ r1, swtich_to_thread ; skip register save at the first time
|
||||
CBZ r1, switch_to_thread ; skip register save at the first time
|
||||
|
||||
MRS r1, psp ; get from thread stack pointer
|
||||
|
||||
@@ -129,7 +129,7 @@ PendSV_Handler PROC
|
||||
LDR r0, [r0]
|
||||
STR r1, [r0] ; update from thread stack pointer
|
||||
|
||||
swtich_to_thread
|
||||
switch_to_thread
|
||||
LDR r1, =rt_interrupt_to_thread
|
||||
LDR r1, [r1]
|
||||
LDR r1, [r1] ; load thread stack pointer
|
||||
|
||||
Reference in New Issue
Block a user