|
@@ -36,64 +36,39 @@ DECLARE_GLOBAL_DATA_PTR;
|
|
|
#include <linux/mtd/mtd.h>
|
|
|
|
|
|
#define SET_CLE 0x10
|
|
|
-#define CLR_CLE ~SET_CLE
|
|
|
#define SET_ALE 0x08
|
|
|
-#define CLR_ALE ~SET_ALE
|
|
|
|
|
|
-static void nand_hwcontrol(struct mtd_info *mtdinfo, int cmd)
|
|
|
+static void nand_hwcontrol(struct mtd_info *mtdinfo, int cmd, unsigned int ctrl)
|
|
|
{
|
|
|
struct nand_chip *this = mtdinfo->priv;
|
|
|
volatile fbcs_t *fbcs = (fbcs_t *) MMAP_FBCS;
|
|
|
u32 nand_baseaddr = (u32) this->IO_ADDR_W;
|
|
|
|
|
|
- switch (cmd) {
|
|
|
- case NAND_CTL_SETNCE:
|
|
|
- case NAND_CTL_CLRNCE:
|
|
|
- break;
|
|
|
- case NAND_CTL_SETCLE:
|
|
|
- nand_baseaddr |= SET_CLE;
|
|
|
- break;
|
|
|
- case NAND_CTL_CLRCLE:
|
|
|
- nand_baseaddr &= CLR_CLE;
|
|
|
- break;
|
|
|
- case NAND_CTL_SETALE:
|
|
|
- nand_baseaddr |= SET_ALE;
|
|
|
- break;
|
|
|
- case NAND_CTL_CLRALE:
|
|
|
- nand_baseaddr |= CLR_ALE;
|
|
|
- break;
|
|
|
- case NAND_CTL_SETWP:
|
|
|
- fbcs->csmr2 |= FBCS_CSMR_WP;
|
|
|
- break;
|
|
|
- case NAND_CTL_CLRWP:
|
|
|
- fbcs->csmr2 &= ~FBCS_CSMR_WP;
|
|
|
- break;
|
|
|
- }
|
|
|
- this->IO_ADDR_W = (void __iomem *)(nand_baseaddr);
|
|
|
-}
|
|
|
+ if (ctrl & NAND_CTRL_CHANGE) {
|
|
|
+ ulong IO_ADDR_W = (ulong) this->IO_ADDR_W;
|
|
|
+ IO_ADDR_W &= ~(SET_ALE | SE_CLE);
|
|
|
|
|
|
-static void nand_write_byte(struct mtd_info *mtdinfo, u_char byte)
|
|
|
-{
|
|
|
- struct nand_chip *this = mtdinfo->priv;
|
|
|
- *((volatile u8 *)(this->IO_ADDR_W)) = byte;
|
|
|
-}
|
|
|
+ if (ctrl & NAND_CLE)
|
|
|
+ IO_ADDR_W |= SET_CLE;
|
|
|
+ if (ctrl & NAND_ALE)
|
|
|
+ IO_ADDR_W |= SET_ALE;
|
|
|
|
|
|
-static u8 nand_read_byte(struct mtd_info *mtdinfo)
|
|
|
-{
|
|
|
- struct nand_chip *this = mtdinfo->priv;
|
|
|
- return (u8) (*((volatile u8 *)this->IO_ADDR_R));
|
|
|
-}
|
|
|
+ at91_set_gpio_value(AT91_PIN_PD15, !(ctrl & NAND_NCE));
|
|
|
+ this->IO_ADDR_W = (void *)IO_ADDR_W;
|
|
|
|
|
|
-static int nand_dev_ready(struct mtd_info *mtdinfo)
|
|
|
-{
|
|
|
- return 1;
|
|
|
+ }
|
|
|
+
|
|
|
+ if (cmd != NAND_CMD_NONE)
|
|
|
+ writeb(cmd, this->IO_ADDR_W);
|
|
|
}
|
|
|
|
|
|
int board_nand_init(struct nand_chip *nand)
|
|
|
{
|
|
|
volatile gpio_t *gpio = (gpio_t *) MMAP_GPIO;
|
|
|
+ volatile fbcs_t *fbcs = (fbcs_t *) MMAP_FBCS;
|
|
|
|
|
|
*((volatile u16 *)CFG_LATCH_ADDR) |= 0x0004;
|
|
|
+ fbcs->csmr2 &= ~FBCS_CSMR_WP;
|
|
|
|
|
|
/* set up pin configuration */
|
|
|
gpio->par_timer &= ~GPIO_PAR_TIN3_TIN3;
|
|
@@ -103,11 +78,8 @@ int board_nand_init(struct nand_chip *nand)
|
|
|
gpio->podr_timer = 0;
|
|
|
|
|
|
nand->chip_delay = 50;
|
|
|
- nand->eccmode = NAND_ECC_SOFT;
|
|
|
- nand->hwcontrol = nand_hwcontrol;
|
|
|
- nand->read_byte = nand_read_byte;
|
|
|
- nand->write_byte = nand_write_byte;
|
|
|
- nand->dev_ready = nand_dev_ready;
|
|
|
+ nand->ecc.mode = NAND_ECC_SOFT;
|
|
|
+ nand->cmd_ctrl = nand_hwcontrol;
|
|
|
|
|
|
return 0;
|
|
|
}
|