1ad309a88SDingqiang Lin /* 2ad309a88SDingqiang Lin * Copyright (c) 2018 Fuzhou Rockchip Electronics Co., Ltd 3ad309a88SDingqiang Lin * 4ba0501acSDingqiang Lin * SPDX-License-Identifier: GPL-2.0 5ad309a88SDingqiang Lin */ 6ad309a88SDingqiang Lin #include <linux/compat.h> 7ba0501acSDingqiang Lin #include <linux/delay.h> 8ba0501acSDingqiang Lin #include <linux/kernel.h> 9ad309a88SDingqiang Lin #include <linux/string.h> 10ad309a88SDingqiang Lin 11ad309a88SDingqiang Lin #include "rkflash_debug.h" 12c84f0ed8SJon Lin #include "sfc_nor.h" 13ad309a88SDingqiang Lin 14ad309a88SDingqiang Lin static struct flash_info spi_flash_tbl[] = { 15ad309a88SDingqiang Lin /* GD25Q32B */ 16ad309a88SDingqiang Lin { 0xc84016, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 13, 9, 0 }, 17ad309a88SDingqiang Lin /* GD25Q64B */ 18ad309a88SDingqiang Lin { 0xc84017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 14, 9, 0 }, 19ad309a88SDingqiang Lin /* GD25Q127C and GD25Q128C*/ 20ad309a88SDingqiang Lin { 0xc84018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 15, 9, 0 }, 211d2de2a9SJon Lin /* GD25Q256B/C/D */ 22*09ad69fdSJon Lin { 0xc84019, 128, 8, 0x13, 0x12, 0x6C, 0x3E, 0x21, 0xDC, 0x3C, 16, 6, 0 }, 23ad309a88SDingqiang Lin /* GD25Q512MC */ 24*09ad69fdSJon Lin { 0xc84020, 128, 8, 0x13, 0x12, 0x6C, 0x3E, 0x21, 0xDC, 0x3C, 17, 6, 0 }, 25e83e4aa5SDingqiang Lin /* 25Q64JVSSIQ */ 26c84f0ed8SJon Lin { 0xef4017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 9, 0 }, 271d2de2a9SJon Lin /* 25Q128FV and 25Q128JV*/ 28ad309a88SDingqiang Lin { 0xef4018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 15, 9, 0 }, 29c84f0ed8SJon Lin /* 25Q256F/J */ 30ad309a88SDingqiang Lin { 0xef4019, 128, 8, 0x13, 0x02, 0x6C, 0x32, 0x20, 0xD8, 0x3C, 16, 9, 0 }, 31e83e4aa5SDingqiang Lin /* 25Q64FWSSIG */ 32c84f0ed8SJon Lin { 0xef6017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 9, 0 }, 331d2de2a9SJon Lin /* MX25L6433F */ 341d2de2a9SJon Lin { 0xc22017, 128, 8, 0x03, 0x02, 0x6B, 0x38, 0x20, 0xD8, 0x0E, 14, 6, 0 }, 351d2de2a9SJon Lin /* MX25L12835E/F MX25L12833FMI-10G */ 361d2de2a9SJon Lin { 0xc22018, 128, 8, 0x03, 0x02, 0x6B, 0x38, 0x20, 0xD8, 0x0E, 15, 6, 0 }, 371d2de2a9SJon Lin /* MX25L25635E/F MX25L25645G MX25L25645GMI-08G*/ 381d2de2a9SJon Lin { 0xc22019, 128, 8, 0x13, 0x12, 0x6C, 0x38, 0x21, 0xDC, 0x3E, 16, 6, 0 }, 391d2de2a9SJon Lin /* MX25L51245GMI */ 401d2de2a9SJon Lin { 0xc2201a, 128, 8, 0x13, 0x12, 0x6C, 0x38, 0x21, 0xDC, 0x3E, 17, 6, 0 }, 411d2de2a9SJon Lin /* XM25QH32C */ 421d2de2a9SJon Lin { 0x204016, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 13, 9, 0 }, 431d2de2a9SJon Lin /* XM25QH64B */ 441d2de2a9SJon Lin { 0x206017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 14, 6, 0 }, 451d2de2a9SJon Lin /* XM25QH128B */ 461d2de2a9SJon Lin { 0x206018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 15, 6, 0 }, 471d2de2a9SJon Lin /* XM25QH(QU)256B */ 481d2de2a9SJon Lin { 0x206019, 128, 8, 0x13, 0x12, 0x6C, 0x3E, 0x21, 0xDC, 0x1D, 16, 6, 0 }, 4940425644SDingqiang Lin /* XM25QH64A */ 5040425644SDingqiang Lin { 0x207017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 0, 0 }, 511d2de2a9SJon Lin /* XT25F128A XM25QH128A */ 521d2de2a9SJon Lin { 0x207018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x00, 15, 0, 0 }, 53c84f0ed8SJon Lin /* XT25F64BSSIGU-5 */ 54c84f0ed8SJon Lin { 0x0b4017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 14, 9, 0 }, 551d2de2a9SJon Lin /* XT25F128BSSIGU */ 561d2de2a9SJon Lin { 0x0b4018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 15, 9, 0 }, 57*09ad69fdSJon Lin /* EN25QH64A */ 58*09ad69fdSJon Lin { 0x1c7017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 0, 0 }, 5940425644SDingqiang Lin /* EN25QH128A */ 6040425644SDingqiang Lin { 0x1c7018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 15, 0, 0 }, 61*09ad69fdSJon Lin /* EN25QH32B */ 62*09ad69fdSJon Lin { 0x1c7016, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 13, 0, 0 }, 631d2de2a9SJon Lin /* EN25S32A */ 641d2de2a9SJon Lin { 0x1c3816, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 13, 0, 0 }, 651d2de2a9SJon Lin /* EN25S64A */ 661d2de2a9SJon Lin { 0x1c3817, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 0, 0 }, 671d2de2a9SJon Lin /* P25Q64H */ 681d2de2a9SJon Lin { 0x856017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 9, 0 }, 69c84f0ed8SJon Lin /* EN25QH256A */ 70c84f0ed8SJon Lin { 0x1c7019, 128, 8, 0x13, 0x12, 0x6C, 0x34, 0x21, 0xDC, 0x3C, 16, 0, 0 }, 71c84f0ed8SJon Lin /* FM25Q64A */ 72c84f0ed8SJon Lin { 0xf83217, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0D, 14, 9, 0 }, 73c84f0ed8SJon Lin /* ZB25VQ64 */ 74c84f0ed8SJon Lin { 0x5e4017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 14, 9, 0 }, 75c84f0ed8SJon Lin /* ZB25VQ128 */ 76c84f0ed8SJon Lin { 0x5e4018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x0C, 15, 9, 0 }, 77*09ad69fdSJon Lin /* 25Q256JVEM */ 78*09ad69fdSJon Lin { 0xef7019, 128, 8, 0x13, 0x12, 0x6C, 0x34, 0x21, 0xDC, 0x3C, 16, 9, 0 }, 79*09ad69fdSJon Lin /* BH25Q128AS */ 80*09ad69fdSJon Lin { 0x684018, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x04, 15, 9, 0 }, 81*09ad69fdSJon Lin /* BH25Q64BS */ 82*09ad69fdSJon Lin { 0x684017, 128, 8, 0x03, 0x02, 0x6B, 0x32, 0x20, 0xD8, 0x04, 14, 9, 0 }, 83ad309a88SDingqiang Lin }; 84ad309a88SDingqiang Lin 85ad309a88SDingqiang Lin static int snor_write_en(void) 86ad309a88SDingqiang Lin { 87ad309a88SDingqiang Lin int ret; 88ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 89ad309a88SDingqiang Lin 90ad309a88SDingqiang Lin sfcmd.d32 = 0; 91ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_WRITE_EN; 92ad309a88SDingqiang Lin 93ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, NULL); 94ad309a88SDingqiang Lin 95ad309a88SDingqiang Lin return ret; 96ad309a88SDingqiang Lin } 97ad309a88SDingqiang Lin 98c84f0ed8SJon Lin int snor_reset_device(void) 99c84f0ed8SJon Lin { 100c84f0ed8SJon Lin int ret; 101c84f0ed8SJon Lin union SFCCMD_DATA sfcmd; 102c84f0ed8SJon Lin 103c84f0ed8SJon Lin sfcmd.d32 = 0; 104c84f0ed8SJon Lin sfcmd.b.cmd = CMD_ENABLE_RESER; 105c84f0ed8SJon Lin sfc_request(sfcmd.d32, 0, 0, NULL); 106c84f0ed8SJon Lin 107c84f0ed8SJon Lin sfcmd.d32 = 0; 108c84f0ed8SJon Lin sfcmd.b.cmd = CMD_RESET_DEVICE; 109c84f0ed8SJon Lin ret = sfc_request(sfcmd.d32, 0, 0, NULL); 110c84f0ed8SJon Lin /* tRST=30us , delay 1ms here */ 111c84f0ed8SJon Lin mdelay(1); 112c84f0ed8SJon Lin return ret; 113c84f0ed8SJon Lin } 114c84f0ed8SJon Lin 115ad309a88SDingqiang Lin static int snor_enter_4byte_mode(void) 116ad309a88SDingqiang Lin { 117ad309a88SDingqiang Lin int ret; 118ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 119ad309a88SDingqiang Lin 120ad309a88SDingqiang Lin sfcmd.d32 = 0; 121ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_ENTER_4BYTE_MODE; 122ad309a88SDingqiang Lin 123ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, NULL); 124ad309a88SDingqiang Lin return ret; 125ad309a88SDingqiang Lin } 126ad309a88SDingqiang Lin 127ad309a88SDingqiang Lin static int snor_read_status(u32 reg_index, u8 *status) 128ad309a88SDingqiang Lin { 129ad309a88SDingqiang Lin int ret; 130ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 131ad309a88SDingqiang Lin u8 read_stat_cmd[] = {CMD_READ_STATUS, 132ad309a88SDingqiang Lin CMD_READ_STATUS2, CMD_READ_STATUS3}; 133ad309a88SDingqiang Lin sfcmd.d32 = 0; 134ad309a88SDingqiang Lin sfcmd.b.cmd = read_stat_cmd[reg_index]; 135ad309a88SDingqiang Lin sfcmd.b.datasize = 1; 136ad309a88SDingqiang Lin 137ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, status); 138ad309a88SDingqiang Lin 139ad309a88SDingqiang Lin return ret; 140ad309a88SDingqiang Lin } 141ad309a88SDingqiang Lin 142ad309a88SDingqiang Lin static int snor_wait_busy(int timeout) 143ad309a88SDingqiang Lin { 144ad309a88SDingqiang Lin int ret; 145ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 146ba0501acSDingqiang Lin int i; 147ba0501acSDingqiang Lin u32 status; 148ad309a88SDingqiang Lin 149ad309a88SDingqiang Lin sfcmd.d32 = 0; 150ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_READ_STATUS; 151ad309a88SDingqiang Lin sfcmd.b.datasize = 1; 152ad309a88SDingqiang Lin 153ad309a88SDingqiang Lin for (i = 0; i < timeout; i++) { 154ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, &status); 155ad309a88SDingqiang Lin if (ret != SFC_OK) 156ad309a88SDingqiang Lin return ret; 157ad309a88SDingqiang Lin 158ad309a88SDingqiang Lin if ((status & 0x01) == 0) 159ad309a88SDingqiang Lin return SFC_OK; 160ad309a88SDingqiang Lin 161ad309a88SDingqiang Lin sfc_delay(1); 162ad309a88SDingqiang Lin } 163c84f0ed8SJon Lin rkflash_print_error("%s error %x\n", __func__, timeout); 164ad309a88SDingqiang Lin 165ad309a88SDingqiang Lin return SFC_BUSY_TIMEOUT; 166ad309a88SDingqiang Lin } 167ad309a88SDingqiang Lin 168ad309a88SDingqiang Lin static int snor_write_status2(u32 reg_index, u8 status) 169ad309a88SDingqiang Lin { 170ad309a88SDingqiang Lin int ret; 171ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 172ad309a88SDingqiang Lin u8 status2[2]; 173ad309a88SDingqiang Lin u8 read_index; 174ad309a88SDingqiang Lin 175ad309a88SDingqiang Lin status2[reg_index] = status; 1761d2de2a9SJon Lin read_index = (reg_index == 0) ? 2 : 0; 1771d2de2a9SJon Lin ret = snor_read_status(read_index, &status2[read_index]); 1781d2de2a9SJon Lin if (ret != SFC_OK) 1791d2de2a9SJon Lin return ret; 1801d2de2a9SJon Lin 1811d2de2a9SJon Lin snor_write_en(); 1821d2de2a9SJon Lin 1831d2de2a9SJon Lin sfcmd.d32 = 0; 1841d2de2a9SJon Lin sfcmd.b.cmd = CMD_WRITE_STATUS; 1851d2de2a9SJon Lin sfcmd.b.datasize = 2; 1861d2de2a9SJon Lin sfcmd.b.rw = SFC_WRITE; 1871d2de2a9SJon Lin 1881d2de2a9SJon Lin ret = sfc_request(sfcmd.d32, 0, 0, &status2[0]); 1891d2de2a9SJon Lin if (ret != SFC_OK) 1901d2de2a9SJon Lin return ret; 1911d2de2a9SJon Lin 1921d2de2a9SJon Lin ret = snor_wait_busy(10000); /* 10ms */ 1931d2de2a9SJon Lin 1941d2de2a9SJon Lin return ret; 1951d2de2a9SJon Lin } 1961d2de2a9SJon Lin 1971d2de2a9SJon Lin static int snor_write_status1(u32 reg_index, u8 status) 1981d2de2a9SJon Lin { 1991d2de2a9SJon Lin int ret; 2001d2de2a9SJon Lin union SFCCMD_DATA sfcmd; 2011d2de2a9SJon Lin u8 status2[2]; 2021d2de2a9SJon Lin u8 read_index; 2031d2de2a9SJon Lin 2041d2de2a9SJon Lin status2[reg_index] = status; 205ad309a88SDingqiang Lin read_index = (reg_index == 0) ? 1 : 0; 206ad309a88SDingqiang Lin ret = snor_read_status(read_index, &status2[read_index]); 207ad309a88SDingqiang Lin if (ret != SFC_OK) 208ad309a88SDingqiang Lin return ret; 209ad309a88SDingqiang Lin 210ad309a88SDingqiang Lin snor_write_en(); 211ad309a88SDingqiang Lin 212ad309a88SDingqiang Lin sfcmd.d32 = 0; 213ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_WRITE_STATUS; 214ad309a88SDingqiang Lin sfcmd.b.datasize = 2; 215ad309a88SDingqiang Lin sfcmd.b.rw = SFC_WRITE; 216ad309a88SDingqiang Lin 217ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, &status2[0]); 218ad309a88SDingqiang Lin if (ret != SFC_OK) 219ad309a88SDingqiang Lin return ret; 220ad309a88SDingqiang Lin 221ad309a88SDingqiang Lin ret = snor_wait_busy(10000); /* 10ms */ 222ad309a88SDingqiang Lin 223ad309a88SDingqiang Lin return ret; 224ad309a88SDingqiang Lin } 225ad309a88SDingqiang Lin 226ad309a88SDingqiang Lin static int snor_write_status(u32 reg_index, u8 status) 227ad309a88SDingqiang Lin { 228ad309a88SDingqiang Lin int ret; 229ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 230ad309a88SDingqiang Lin u8 write_stat_cmd[] = {CMD_WRITE_STATUS, 231ad309a88SDingqiang Lin CMD_WRITE_STATUS2, CMD_WRITE_STATUS3}; 232ad309a88SDingqiang Lin snor_write_en(); 233ad309a88SDingqiang Lin sfcmd.d32 = 0; 234ad309a88SDingqiang Lin sfcmd.b.cmd = write_stat_cmd[reg_index]; 235ad309a88SDingqiang Lin sfcmd.b.datasize = 1; 236ad309a88SDingqiang Lin sfcmd.b.rw = SFC_WRITE; 237ad309a88SDingqiang Lin 238ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, &status); 239ad309a88SDingqiang Lin if (ret != SFC_OK) 240ad309a88SDingqiang Lin return ret; 241ad309a88SDingqiang Lin 242ad309a88SDingqiang Lin ret = snor_wait_busy(10000); /* 10ms */ 243ad309a88SDingqiang Lin 244ad309a88SDingqiang Lin return ret; 245ad309a88SDingqiang Lin } 246ad309a88SDingqiang Lin 247c84f0ed8SJon Lin int snor_erase(struct SFNOR_DEV *p_dev, 248ad309a88SDingqiang Lin u32 addr, 249ad309a88SDingqiang Lin enum NOR_ERASE_TYPE erase_type) 250ad309a88SDingqiang Lin { 251ad309a88SDingqiang Lin int ret; 252ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 253ad309a88SDingqiang Lin int timeout[] = {400, 2000, 40000}; /* ms */ 254ad309a88SDingqiang Lin 2557edaca22SJon Lin rkflash_print_dio("%s %x\n", __func__, addr); 2567edaca22SJon Lin 257ad309a88SDingqiang Lin if (erase_type > ERASE_CHIP) 258ad309a88SDingqiang Lin return SFC_PARAM_ERR; 259ad309a88SDingqiang Lin 260ad309a88SDingqiang Lin sfcmd.d32 = 0; 261ad309a88SDingqiang Lin if (erase_type == ERASE_BLOCK64K) 262ad309a88SDingqiang Lin sfcmd.b.cmd = p_dev->blk_erase_cmd; 263ad309a88SDingqiang Lin else if (erase_type == ERASE_SECTOR) 264ad309a88SDingqiang Lin sfcmd.b.cmd = p_dev->sec_erase_cmd; 265ad309a88SDingqiang Lin else 266ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_CHIP_ERASE; 267ad309a88SDingqiang Lin 268ad309a88SDingqiang Lin sfcmd.b.addrbits = (erase_type != ERASE_CHIP) ? 269ad309a88SDingqiang Lin SFC_ADDR_24BITS : SFC_ADDR_0BITS; 270ba0501acSDingqiang Lin if (p_dev->addr_mode == ADDR_MODE_4BYTE && erase_type != ERASE_CHIP) 271ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_32BITS; 272ad309a88SDingqiang Lin 273ad309a88SDingqiang Lin snor_write_en(); 274ad309a88SDingqiang Lin 275ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, addr, NULL); 276ad309a88SDingqiang Lin if (ret != SFC_OK) 277ad309a88SDingqiang Lin return ret; 278ad309a88SDingqiang Lin 279ad309a88SDingqiang Lin ret = snor_wait_busy(timeout[erase_type] * 1000); 280ad309a88SDingqiang Lin return ret; 281ad309a88SDingqiang Lin } 282ad309a88SDingqiang Lin 283c84f0ed8SJon Lin int snor_prog_page(struct SFNOR_DEV *p_dev, 284ad309a88SDingqiang Lin u32 addr, 285ad309a88SDingqiang Lin void *p_data, 286ad309a88SDingqiang Lin u32 size) 287ad309a88SDingqiang Lin { 288ad309a88SDingqiang Lin int ret; 289ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 290ad309a88SDingqiang Lin union SFCCTRL_DATA sfctrl; 291ad309a88SDingqiang Lin 292*09ad69fdSJon Lin rkflash_print_dio("%s %x %x\n", __func__, addr, *(u32 *)(p_data)); 293*09ad69fdSJon Lin 294ad309a88SDingqiang Lin sfcmd.d32 = 0; 295ad309a88SDingqiang Lin sfcmd.b.cmd = p_dev->prog_cmd; 296ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_24BITS; 297ad309a88SDingqiang Lin sfcmd.b.datasize = size; 298ad309a88SDingqiang Lin sfcmd.b.rw = SFC_WRITE; 299ad309a88SDingqiang Lin 300ad309a88SDingqiang Lin sfctrl.d32 = 0; 301ad309a88SDingqiang Lin sfctrl.b.datalines = p_dev->prog_lines; 302ad309a88SDingqiang Lin sfctrl.b.enbledma = 0; 303ad309a88SDingqiang Lin if (p_dev->prog_cmd == CMD_PAGE_PROG_A4) 304ad309a88SDingqiang Lin sfctrl.b.addrlines = SFC_4BITS_LINE; 305ad309a88SDingqiang Lin 306ad309a88SDingqiang Lin if (p_dev->addr_mode == ADDR_MODE_4BYTE) 307ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_32BITS; 308ad309a88SDingqiang Lin 309ad309a88SDingqiang Lin snor_write_en(); 310ad309a88SDingqiang Lin 311ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, sfctrl.d32, addr, p_data); 312ad309a88SDingqiang Lin if (ret != SFC_OK) 313ad309a88SDingqiang Lin return ret; 314ad309a88SDingqiang Lin 315ad309a88SDingqiang Lin ret = snor_wait_busy(10000); 316ad309a88SDingqiang Lin 317ad309a88SDingqiang Lin return ret; 318ad309a88SDingqiang Lin } 319ad309a88SDingqiang Lin 320ad309a88SDingqiang Lin static int snor_prog(struct SFNOR_DEV *p_dev, u32 addr, void *p_data, u32 size) 321ad309a88SDingqiang Lin { 322ad309a88SDingqiang Lin int ret = SFC_OK; 323ad309a88SDingqiang Lin u32 page_size, len; 324ad309a88SDingqiang Lin u8 *p_buf = (u8 *)p_data; 325ad309a88SDingqiang Lin 326ad309a88SDingqiang Lin page_size = NOR_PAGE_SIZE; 327ad309a88SDingqiang Lin while (size) { 328ad309a88SDingqiang Lin len = page_size < size ? page_size : size; 329ad309a88SDingqiang Lin ret = snor_prog_page(p_dev, addr, p_buf, len); 330ad309a88SDingqiang Lin if (ret != SFC_OK) 331ad309a88SDingqiang Lin return ret; 332ad309a88SDingqiang Lin 333ad309a88SDingqiang Lin size -= len; 334ad309a88SDingqiang Lin addr += len; 335ad309a88SDingqiang Lin p_buf += len; 336ad309a88SDingqiang Lin } 337ad309a88SDingqiang Lin 338ad309a88SDingqiang Lin return ret; 339ad309a88SDingqiang Lin } 340ad309a88SDingqiang Lin 341ad309a88SDingqiang Lin static int snor_enable_QE(struct SFNOR_DEV *p_dev) 342ad309a88SDingqiang Lin { 343ad309a88SDingqiang Lin int ret = SFC_OK; 344ad309a88SDingqiang Lin int reg_index; 345ad309a88SDingqiang Lin int bit_offset; 346ad309a88SDingqiang Lin u8 status; 347ad309a88SDingqiang Lin 348ad309a88SDingqiang Lin reg_index = p_dev->QE_bits >> 3; 349ad309a88SDingqiang Lin bit_offset = p_dev->QE_bits & 0x7; 350ad309a88SDingqiang Lin ret = snor_read_status(reg_index, &status); 351ad309a88SDingqiang Lin if (ret != SFC_OK) 352ad309a88SDingqiang Lin return ret; 353ad309a88SDingqiang Lin 354ad309a88SDingqiang Lin if (status & (1 << bit_offset)) /* is QE bit set */ 355ad309a88SDingqiang Lin return SFC_OK; 356ad309a88SDingqiang Lin 357ad309a88SDingqiang Lin status |= (1 << bit_offset); 358ad309a88SDingqiang Lin 359*09ad69fdSJon Lin return p_dev->write_status(reg_index, status); 360ad309a88SDingqiang Lin } 361ad309a88SDingqiang Lin 362c84f0ed8SJon Lin int snor_disable_QE(struct SFNOR_DEV *p_dev) 363ad309a88SDingqiang Lin { 364c84f0ed8SJon Lin int ret = SFC_OK; 365c84f0ed8SJon Lin int reg_index; 366c84f0ed8SJon Lin int bit_offset; 367c84f0ed8SJon Lin u8 status; 368ad309a88SDingqiang Lin 369c84f0ed8SJon Lin reg_index = p_dev->QE_bits >> 3; 370c84f0ed8SJon Lin bit_offset = p_dev->QE_bits & 0x7; 371c84f0ed8SJon Lin ret = snor_read_status(reg_index, &status); 372c84f0ed8SJon Lin if (ret != SFC_OK) 373c84f0ed8SJon Lin return ret; 374ad309a88SDingqiang Lin 375c84f0ed8SJon Lin if (!(status & (1 << bit_offset))) 376ad309a88SDingqiang Lin return SFC_OK; 377ad309a88SDingqiang Lin 378c84f0ed8SJon Lin status &= ~(1 << bit_offset); 379c84f0ed8SJon Lin 380*09ad69fdSJon Lin return p_dev->write_status(reg_index, status); 381c84f0ed8SJon Lin } 382c84f0ed8SJon Lin 383c84f0ed8SJon Lin int snor_read_data(struct SFNOR_DEV *p_dev, 384ad309a88SDingqiang Lin u32 addr, 385ad309a88SDingqiang Lin void *p_data, 386ad309a88SDingqiang Lin u32 size) 387ad309a88SDingqiang Lin { 388ad309a88SDingqiang Lin int ret; 389ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 390ad309a88SDingqiang Lin union SFCCTRL_DATA sfctrl; 391ad309a88SDingqiang Lin 392ad309a88SDingqiang Lin sfcmd.d32 = 0; 393ad309a88SDingqiang Lin sfcmd.b.cmd = p_dev->read_cmd; 394ad309a88SDingqiang Lin sfcmd.b.datasize = size; 395ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_24BITS; 396ad309a88SDingqiang Lin 397ad309a88SDingqiang Lin sfctrl.d32 = 0; 398ad309a88SDingqiang Lin sfctrl.b.datalines = p_dev->read_lines; 399ad309a88SDingqiang Lin if (!(size & 0x3) && size >= 4) 400ad309a88SDingqiang Lin sfctrl.b.enbledma = 0; 401ad309a88SDingqiang Lin 402ad309a88SDingqiang Lin if (p_dev->read_cmd == CMD_FAST_READ_X1 || 403ad309a88SDingqiang Lin p_dev->read_cmd == CMD_FAST_READ_X4 || 404ad309a88SDingqiang Lin p_dev->read_cmd == CMD_FAST_READ_X2 || 405ad309a88SDingqiang Lin p_dev->read_cmd == CMD_FAST_4READ_X4) { 406ad309a88SDingqiang Lin sfcmd.b.dummybits = 8; 407ad309a88SDingqiang Lin } else if (p_dev->read_cmd == CMD_FAST_READ_A4) { 408ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_32BITS; 409ad309a88SDingqiang Lin addr = (addr << 8) | 0xFF; /* Set M[7:0] = 0xFF */ 410ad309a88SDingqiang Lin sfcmd.b.dummybits = 4; 411ad309a88SDingqiang Lin sfctrl.b.addrlines = SFC_4BITS_LINE; 412ad309a88SDingqiang Lin } 413ad309a88SDingqiang Lin 414ad309a88SDingqiang Lin if (p_dev->addr_mode == ADDR_MODE_4BYTE) 415ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_32BITS; 416ad309a88SDingqiang Lin 417ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, sfctrl.d32, addr, p_data); 418*09ad69fdSJon Lin rkflash_print_dio("%s %x %x\n", __func__, addr, *(u32 *)(p_data)); 419ad309a88SDingqiang Lin 420ad309a88SDingqiang Lin return ret; 421ad309a88SDingqiang Lin } 422ad309a88SDingqiang Lin 423ad309a88SDingqiang Lin int snor_read(struct SFNOR_DEV *p_dev, u32 sec, u32 n_sec, void *p_data) 424ad309a88SDingqiang Lin { 425ad309a88SDingqiang Lin int ret = SFC_OK; 426ad309a88SDingqiang Lin u32 addr, size, len; 427ad309a88SDingqiang Lin u8 *p_buf = (u8 *)p_data; 428ad309a88SDingqiang Lin 4297edaca22SJon Lin rkflash_print_dio("%s %x %x\n", __func__, sec, n_sec); 4307edaca22SJon Lin 431ad309a88SDingqiang Lin if ((sec + n_sec) > p_dev->capacity) 432ad309a88SDingqiang Lin return SFC_PARAM_ERR; 433ad309a88SDingqiang Lin 434ad309a88SDingqiang Lin addr = sec << 9; 435ad309a88SDingqiang Lin size = n_sec << 9; 436ad309a88SDingqiang Lin while (size) { 437ad309a88SDingqiang Lin len = size < SFC_MAX_IOSIZE ? size : SFC_MAX_IOSIZE; 438ad309a88SDingqiang Lin ret = snor_read_data(p_dev, addr, p_buf, len); 439ad309a88SDingqiang Lin if (ret != SFC_OK) { 440c84f0ed8SJon Lin rkflash_print_error("snor_read_data %x ret= %x\n", 441ad309a88SDingqiang Lin addr >> 9, ret); 442ad309a88SDingqiang Lin goto out; 443ad309a88SDingqiang Lin } 444ad309a88SDingqiang Lin 445ad309a88SDingqiang Lin size -= len; 446ad309a88SDingqiang Lin addr += len; 447ad309a88SDingqiang Lin p_buf += len; 448ad309a88SDingqiang Lin } 449ad309a88SDingqiang Lin out: 450ad309a88SDingqiang Lin if (!ret) 451ad309a88SDingqiang Lin ret = n_sec; 452ad309a88SDingqiang Lin 453ad309a88SDingqiang Lin return ret; 454ad309a88SDingqiang Lin } 455ad309a88SDingqiang Lin 456c84f0ed8SJon Lin int snor_write(struct SFNOR_DEV *p_dev, u32 sec, u32 n_sec, void *p_data) 457ad309a88SDingqiang Lin { 458ad309a88SDingqiang Lin int ret = SFC_OK; 459ad309a88SDingqiang Lin u32 len, blk_size, offset; 460ad309a88SDingqiang Lin u8 *p_buf = (u8 *)p_data; 461ba0501acSDingqiang Lin u32 total_sec = n_sec; 462ad309a88SDingqiang Lin 463*09ad69fdSJon Lin rkflash_print_dio("%s %x %x\n", __func__, sec, n_sec); 4647edaca22SJon Lin 465ad309a88SDingqiang Lin if ((sec + n_sec) > p_dev->capacity) 466ad309a88SDingqiang Lin return SFC_PARAM_ERR; 467ad309a88SDingqiang Lin 468ad309a88SDingqiang Lin while (n_sec) { 469ad309a88SDingqiang Lin if (sec < 512 || sec >= p_dev->capacity - 512) 470ad309a88SDingqiang Lin blk_size = 8; 471ad309a88SDingqiang Lin else 472ad309a88SDingqiang Lin blk_size = p_dev->blk_size; 473ad309a88SDingqiang Lin 474ad309a88SDingqiang Lin offset = (sec & (blk_size - 1)); 475ad309a88SDingqiang Lin if (!offset) { 476ad309a88SDingqiang Lin ret = snor_erase(p_dev, sec << 9, (blk_size == 8) ? 477ad309a88SDingqiang Lin ERASE_SECTOR : ERASE_BLOCK64K); 478ad309a88SDingqiang Lin if (ret != SFC_OK) { 479c84f0ed8SJon Lin rkflash_print_error("snor_erase %x ret= %x\n", 480ad309a88SDingqiang Lin sec, ret); 481ad309a88SDingqiang Lin goto out; 482ad309a88SDingqiang Lin } 483ad309a88SDingqiang Lin } 484ad309a88SDingqiang Lin len = (blk_size - offset) < n_sec ? 485ad309a88SDingqiang Lin (blk_size - offset) : n_sec; 486ad309a88SDingqiang Lin ret = snor_prog(p_dev, sec << 9, p_buf, len << 9); 487ad309a88SDingqiang Lin if (ret != SFC_OK) { 488c84f0ed8SJon Lin rkflash_print_error("snor_prog %x ret= %x\n", sec, ret); 489ad309a88SDingqiang Lin goto out; 490ad309a88SDingqiang Lin } 491ad309a88SDingqiang Lin n_sec -= len; 492ad309a88SDingqiang Lin sec += len; 493ad309a88SDingqiang Lin p_buf += len << 9; 494ad309a88SDingqiang Lin } 495ad309a88SDingqiang Lin out: 496ad309a88SDingqiang Lin if (!ret) 497ba0501acSDingqiang Lin ret = total_sec; 498ad309a88SDingqiang Lin 499ad309a88SDingqiang Lin return ret; 500ad309a88SDingqiang Lin } 501ad309a88SDingqiang Lin 502c84f0ed8SJon Lin int snor_read_id(u8 *data) 503ad309a88SDingqiang Lin { 504ad309a88SDingqiang Lin int ret; 505ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 506ad309a88SDingqiang Lin 507ad309a88SDingqiang Lin sfcmd.d32 = 0; 508ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_READ_JEDECID; 509ad309a88SDingqiang Lin sfcmd.b.datasize = 3; 510ad309a88SDingqiang Lin 511ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, 0, data); 512ad309a88SDingqiang Lin 513ad309a88SDingqiang Lin return ret; 514ad309a88SDingqiang Lin } 515ad309a88SDingqiang Lin 516ad309a88SDingqiang Lin static int snor_read_parameter(u32 addr, u8 *data) 517ad309a88SDingqiang Lin { 518ad309a88SDingqiang Lin int ret; 519ad309a88SDingqiang Lin union SFCCMD_DATA sfcmd; 520ad309a88SDingqiang Lin 521ad309a88SDingqiang Lin sfcmd.d32 = 0; 522ad309a88SDingqiang Lin sfcmd.b.cmd = CMD_READ_PARAMETER; 523ad309a88SDingqiang Lin sfcmd.b.datasize = 1; 524ad309a88SDingqiang Lin sfcmd.b.addrbits = SFC_ADDR_24BITS; 525ad309a88SDingqiang Lin sfcmd.b.dummybits = 8; 526ad309a88SDingqiang Lin 527ad309a88SDingqiang Lin ret = sfc_request(sfcmd.d32, 0, addr, data); 528ad309a88SDingqiang Lin 529ad309a88SDingqiang Lin return ret; 530ad309a88SDingqiang Lin } 531ad309a88SDingqiang Lin 532ad309a88SDingqiang Lin u32 snor_get_capacity(struct SFNOR_DEV *p_dev) 533ad309a88SDingqiang Lin { 534ad309a88SDingqiang Lin return p_dev->capacity; 535ad309a88SDingqiang Lin } 536ad309a88SDingqiang Lin 537ad309a88SDingqiang Lin static struct flash_info *snor_get_flash_info(u8 *flash_id) 538ad309a88SDingqiang Lin { 539ad309a88SDingqiang Lin u32 i; 540ad309a88SDingqiang Lin u32 id = (flash_id[0] << 16) | (flash_id[1] << 8) | (flash_id[2] << 0); 541ad309a88SDingqiang Lin 542ba0501acSDingqiang Lin for (i = 0; i < ARRAY_SIZE(spi_flash_tbl); i++) { 543ad309a88SDingqiang Lin if (spi_flash_tbl[i].id == id) 544ad309a88SDingqiang Lin return &spi_flash_tbl[i]; 545ad309a88SDingqiang Lin } 546ad309a88SDingqiang Lin return NULL; 547ad309a88SDingqiang Lin } 548ad309a88SDingqiang Lin 549ad309a88SDingqiang Lin /* Adjust flash info in ram base on parameter */ 550ad309a88SDingqiang Lin static void *snor_flash_info_adjust(struct flash_info *spi_flash_info) 551ad309a88SDingqiang Lin { 552ad309a88SDingqiang Lin u32 addr; 553ad309a88SDingqiang Lin u8 para_version; 554ad309a88SDingqiang Lin 555ad309a88SDingqiang Lin if (spi_flash_info->id == 0xc84019) { 556ad309a88SDingqiang Lin addr = 0x09; 557ad309a88SDingqiang Lin snor_read_parameter(addr, ¶_version); 558ad309a88SDingqiang Lin if (para_version == 0x06) { 559ad309a88SDingqiang Lin spi_flash_info->QE_bits = 9; 560ad309a88SDingqiang Lin spi_flash_info->prog_cmd_4 = 0x34; 561ad309a88SDingqiang Lin } 562ad309a88SDingqiang Lin } 563ad309a88SDingqiang Lin return 0; 564ad309a88SDingqiang Lin } 565ad309a88SDingqiang Lin 566ad309a88SDingqiang Lin int snor_init(struct SFNOR_DEV *p_dev) 567ad309a88SDingqiang Lin { 568c84f0ed8SJon Lin struct flash_info *g_spi_flash_info; 569*09ad69fdSJon Lin u32 i, ret; 570ad309a88SDingqiang Lin u8 id_byte[5]; 571c84f0ed8SJon Lin 572c84f0ed8SJon Lin if (!p_dev) 573c84f0ed8SJon Lin return SFC_PARAM_ERR; 574ad309a88SDingqiang Lin 575ad309a88SDingqiang Lin memset(p_dev, 0, sizeof(struct SFNOR_DEV)); 576ad309a88SDingqiang Lin snor_read_id(id_byte); 577c84f0ed8SJon Lin rkflash_print_error("sfc nor id: %x %x %x\n", 578ad309a88SDingqiang Lin id_byte[0], id_byte[1], id_byte[2]); 579c84f0ed8SJon Lin if (0xFF == id_byte[0] || 0x00 == id_byte[0]) 580c84f0ed8SJon Lin return SFC_ERROR; 581ad309a88SDingqiang Lin 582ad309a88SDingqiang Lin p_dev->manufacturer = id_byte[0]; 583ad309a88SDingqiang Lin p_dev->mem_type = id_byte[1]; 584ad309a88SDingqiang Lin 585ad309a88SDingqiang Lin g_spi_flash_info = snor_get_flash_info(id_byte); 586ad309a88SDingqiang Lin if (g_spi_flash_info) { 587ad309a88SDingqiang Lin snor_flash_info_adjust(g_spi_flash_info); 588ad309a88SDingqiang Lin p_dev->capacity = 1 << g_spi_flash_info->density; 589ad309a88SDingqiang Lin p_dev->blk_size = g_spi_flash_info->block_size; 590ad309a88SDingqiang Lin p_dev->page_size = NOR_SECS_PAGE; 591ad309a88SDingqiang Lin p_dev->read_cmd = g_spi_flash_info->read_cmd; 592ad309a88SDingqiang Lin p_dev->prog_cmd = g_spi_flash_info->prog_cmd; 593ad309a88SDingqiang Lin p_dev->sec_erase_cmd = g_spi_flash_info->sector_erase_cmd; 594ad309a88SDingqiang Lin p_dev->blk_erase_cmd = g_spi_flash_info->block_erase_cmd; 595ad309a88SDingqiang Lin p_dev->prog_lines = DATA_LINES_X1; 596ad309a88SDingqiang Lin p_dev->read_lines = DATA_LINES_X1; 597ad309a88SDingqiang Lin p_dev->QE_bits = g_spi_flash_info->QE_bits; 598c84f0ed8SJon Lin p_dev->addr_mode = ADDR_MODE_3BYTE; 599ad309a88SDingqiang Lin 600ad309a88SDingqiang Lin i = g_spi_flash_info->feature & FEA_READ_STATUE_MASK; 601ad309a88SDingqiang Lin if (i == 0) 602ad309a88SDingqiang Lin p_dev->write_status = snor_write_status; 6031d2de2a9SJon Lin else if (i == 1) 6041d2de2a9SJon Lin p_dev->write_status = snor_write_status1; 6051d2de2a9SJon Lin else if (i == 2) 606ad309a88SDingqiang Lin p_dev->write_status = snor_write_status2; 607ad309a88SDingqiang Lin if (g_spi_flash_info->feature & FEA_4BIT_READ) { 608*09ad69fdSJon Lin ret = SFC_OK; 609*09ad69fdSJon Lin if (g_spi_flash_info->QE_bits) 610*09ad69fdSJon Lin ret = snor_enable_QE(p_dev); 611*09ad69fdSJon Lin if (ret == SFC_OK) { 612ad309a88SDingqiang Lin p_dev->read_lines = DATA_LINES_X4; 613ad309a88SDingqiang Lin p_dev->read_cmd = g_spi_flash_info->read_cmd_4; 614ad309a88SDingqiang Lin } 615ad309a88SDingqiang Lin } 616ba0501acSDingqiang Lin if (g_spi_flash_info->feature & FEA_4BIT_PROG && 617ba0501acSDingqiang Lin p_dev->read_lines == DATA_LINES_X4) { 618ad309a88SDingqiang Lin p_dev->prog_lines = DATA_LINES_X4; 619ad309a88SDingqiang Lin p_dev->prog_cmd = g_spi_flash_info->prog_cmd_4; 620ad309a88SDingqiang Lin } 621ad309a88SDingqiang Lin 622ad309a88SDingqiang Lin if (g_spi_flash_info->feature & FEA_4BYTE_ADDR) 623ad309a88SDingqiang Lin p_dev->addr_mode = ADDR_MODE_4BYTE; 624ad309a88SDingqiang Lin 625ad309a88SDingqiang Lin if ((g_spi_flash_info->feature & FEA_4BYTE_ADDR_MODE)) 626ad309a88SDingqiang Lin snor_enter_4byte_mode(); 627c84f0ed8SJon Lin } else { 628c84f0ed8SJon Lin p_dev->capacity = 1 << id_byte[2] >> 3; 629c84f0ed8SJon Lin p_dev->QE_bits = 0; 630ad309a88SDingqiang Lin p_dev->blk_size = NOR_SECS_BLK; 631ad309a88SDingqiang Lin p_dev->page_size = NOR_SECS_PAGE; 632ad309a88SDingqiang Lin p_dev->read_cmd = CMD_READ_DATA; 633ad309a88SDingqiang Lin p_dev->prog_cmd = CMD_PAGE_PROG; 634ad309a88SDingqiang Lin p_dev->sec_erase_cmd = CMD_SECTOR_ERASE; 635ad309a88SDingqiang Lin p_dev->blk_erase_cmd = CMD_BLOCK_ERASE; 636c84f0ed8SJon Lin p_dev->prog_lines = DATA_LINES_X1; 637c84f0ed8SJon Lin p_dev->read_lines = DATA_LINES_X1; 638c84f0ed8SJon Lin p_dev->write_status = snor_write_status; 639c84f0ed8SJon Lin } 640ad309a88SDingqiang Lin 641c84f0ed8SJon Lin rkflash_print_info("addr_mode: %x\n", p_dev->addr_mode); 642c84f0ed8SJon Lin rkflash_print_info("read_lines: %x\n", p_dev->read_lines); 643c84f0ed8SJon Lin rkflash_print_info("prog_lines: %x\n", p_dev->prog_lines); 644c84f0ed8SJon Lin rkflash_print_info("read_cmd: %x\n", p_dev->read_cmd); 645c84f0ed8SJon Lin rkflash_print_info("prog_cmd: %x\n", p_dev->prog_cmd); 646c84f0ed8SJon Lin rkflash_print_info("blk_erase_cmd: %x\n", p_dev->blk_erase_cmd); 647c84f0ed8SJon Lin rkflash_print_info("sec_erase_cmd: %x\n", p_dev->sec_erase_cmd); 648ad309a88SDingqiang Lin 649ad309a88SDingqiang Lin return SFC_OK; 650ad309a88SDingqiang Lin } 651ad309a88SDingqiang Lin 652