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