Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-or-later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3)  * Probing flash chips with QINFO records.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4)  * (C) 2008 Korolev Alexey <akorolev@infradead.org>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5)  * (C) 2008 Vasiliy Leonenko <vasiliy.leonenko@gmail.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/types.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/kernel.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/errno.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/interrupt.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/mtd/xip.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/mtd/map.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/mtd/pfow.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/mtd/qinfo.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) static int lpddr_chip_setup(struct map_info *map, struct lpddr_private *lpddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) struct mtd_info *lpddr_probe(struct map_info *map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) static struct lpddr_private *lpddr_probe_chip(struct map_info *map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) static int lpddr_pfow_present(struct map_info *map,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) 			struct lpddr_private *lpddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) static struct qinfo_query_info qinfo_array[] = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) 	/* General device info */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 	{0, 0, "DevSizeShift", "Device size 2^n bytes"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) 	{0, 3, "BufSizeShift", "Program buffer size 2^n bytes"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) 	/* Erase block information */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) 	{1, 1, "TotalBlocksNum", "Total number of blocks"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) 	{1, 2, "UniformBlockSizeShift", "Uniform block size 2^n bytes"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) 	/* Partition information */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 	{2, 1, "HWPartsNum", "Number of hardware partitions"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) 	/* Optional features */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) 	{5, 1, "SuspEraseSupp", "Suspend erase supported"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 	/* Operation typical time */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) 	{10, 0, "SingleWordProgTime", "Single word program 2^n u-sec"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) 	{10, 1, "ProgBufferTime", "Program buffer write 2^n u-sec"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 	{10, 2, "BlockEraseTime", "Block erase 2^n m-sec"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) 	{10, 3, "FullChipEraseTime", "Full chip erase 2^n m-sec"},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) static long lpddr_get_qinforec_pos(struct map_info *map, char *id_str)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	int qinfo_lines = ARRAY_SIZE(qinfo_array);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	int bankwidth = map_bankwidth(map) * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) 	int major, minor;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) 	for (i = 0; i < qinfo_lines; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) 		if (strcmp(id_str, qinfo_array[i].id_str) == 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 			major = qinfo_array[i].major & ((1 << bankwidth) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 			minor = qinfo_array[i].minor & ((1 << bankwidth) - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 			return minor | (major << bankwidth);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 	printk(KERN_ERR"%s qinfo id string is wrong! \n", map->name);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) 	BUG();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) 	return -1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) static uint16_t lpddr_info_query(struct map_info *map, char *id_str)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 	unsigned int dsr, val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) 	int bits_per_chip = map_bankwidth(map) * 8;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) 	unsigned long adr = lpddr_get_qinforec_pos(map, id_str);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	int attempts = 20;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	/* Write a request for the PFOW record */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 	map_write(map, CMD(LPDDR_INFO_QUERY),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 			map->pfow_base + PFOW_COMMAND_CODE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 	map_write(map, CMD(adr & ((1 << bits_per_chip) - 1)),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 			map->pfow_base + PFOW_COMMAND_ADDRESS_L);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	map_write(map, CMD(adr >> bits_per_chip),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) 			map->pfow_base + PFOW_COMMAND_ADDRESS_H);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 	map_write(map, CMD(LPDDR_START_EXECUTION),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) 			map->pfow_base + PFOW_COMMAND_EXECUTE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	while ((attempts--) > 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		dsr = CMDVAL(map_read(map, map->pfow_base + PFOW_DSR));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		if (dsr & DSR_READY_STATUS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 		udelay(10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) 	val = CMDVAL(map_read(map, map->pfow_base + PFOW_COMMAND_DATA));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 	return val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) static int lpddr_pfow_present(struct map_info *map, struct lpddr_private *lpddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	map_word pfow_val[4];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	/* Check identification string */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 	pfow_val[0] = map_read(map, map->pfow_base + PFOW_QUERY_STRING_P);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	pfow_val[1] = map_read(map, map->pfow_base + PFOW_QUERY_STRING_F);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) 	pfow_val[2] = map_read(map, map->pfow_base + PFOW_QUERY_STRING_O);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 	pfow_val[3] = map_read(map, map->pfow_base + PFOW_QUERY_STRING_W);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) 	if (!map_word_equal(map, CMD('P'), pfow_val[0]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	if (!map_word_equal(map, CMD('F'), pfow_val[1]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 	if (!map_word_equal(map, CMD('O'), pfow_val[2]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	if (!map_word_equal(map, CMD('W'), pfow_val[3]))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 	return 1;	/* "PFOW" is found */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 	printk(KERN_WARNING"%s: PFOW string at 0x%lx is not found \n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 					map->name, map->pfow_base);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) static int lpddr_chip_setup(struct map_info *map, struct lpddr_private *lpddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) 	lpddr->qinfo = kzalloc(sizeof(struct qinfo_chip), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 	if (!lpddr->qinfo)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	/* Get the ManuID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 	lpddr->ManufactId = CMDVAL(map_read(map, map->pfow_base + PFOW_MANUFACTURER_ID));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	/* Get the DeviceID */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 	lpddr->DevId = CMDVAL(map_read(map, map->pfow_base + PFOW_DEVICE_ID));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) 	/* read parameters from chip qinfo table */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 	lpddr->qinfo->DevSizeShift = lpddr_info_query(map, "DevSizeShift");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) 	lpddr->qinfo->TotalBlocksNum = lpddr_info_query(map, "TotalBlocksNum");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	lpddr->qinfo->BufSizeShift = lpddr_info_query(map, "BufSizeShift");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	lpddr->qinfo->HWPartsNum = lpddr_info_query(map, "HWPartsNum");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	lpddr->qinfo->UniformBlockSizeShift =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 				lpddr_info_query(map, "UniformBlockSizeShift");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) 	lpddr->qinfo->SuspEraseSupp = lpddr_info_query(map, "SuspEraseSupp");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 	lpddr->qinfo->SingleWordProgTime =
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) 				lpddr_info_query(map, "SingleWordProgTime");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) 	lpddr->qinfo->ProgBufferTime = lpddr_info_query(map, "ProgBufferTime");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	lpddr->qinfo->BlockEraseTime = lpddr_info_query(map, "BlockEraseTime");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	return 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) static struct lpddr_private *lpddr_probe_chip(struct map_info *map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 	struct lpddr_private lpddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	struct lpddr_private *retlpddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	int numvirtchips;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	if ((map->pfow_base + 0x1000) >= map->size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 		printk(KERN_NOTICE"%s Probe at base (0x%08lx) past the end of"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 				"the map(0x%08lx)\n", map->name,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 				(unsigned long)map->pfow_base, map->size - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	memset(&lpddr, 0, sizeof(struct lpddr_private));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	if (!lpddr_pfow_present(map, &lpddr))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	if (!lpddr_chip_setup(map, &lpddr))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	/* Ok so we found a chip */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	lpddr.chipshift = lpddr.qinfo->DevSizeShift;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	lpddr.numchips = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	numvirtchips = lpddr.numchips * lpddr.qinfo->HWPartsNum;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	retlpddr = kzalloc(struct_size(retlpddr, chips, numvirtchips),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) 			   GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 	if (!retlpddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	memcpy(retlpddr, &lpddr, sizeof(struct lpddr_private));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 	retlpddr->numchips = numvirtchips;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	retlpddr->chipshift = retlpddr->qinfo->DevSizeShift -
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 				__ffs(retlpddr->qinfo->HWPartsNum);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 	return retlpddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) struct mtd_info *lpddr_probe(struct map_info *map)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	struct mtd_info *mtd = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 	struct lpddr_private *lpddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	/* First probe the map to see if we havecan open PFOW here */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 	lpddr = lpddr_probe_chip(map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	if (!lpddr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	map->fldrv_priv = lpddr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 	mtd = lpddr_cmdset(map);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	if (mtd) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) 		if (mtd->size > map->size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 			printk(KERN_WARNING "Reducing visibility of %ldKiB chip"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) 				"to %ldKiB\n", (unsigned long)mtd->size >> 10,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) 				(unsigned long)map->size >> 10);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 			mtd->size = map->size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 		return mtd;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 	kfree(lpddr->qinfo);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 	kfree(lpddr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	map->fldrv_priv = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 	return NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) static struct mtd_chip_driver lpddr_chipdrv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) 	.probe		= lpddr_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) 	.name		= "qinfo_probe",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	.module		= THIS_MODULE
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) static int __init lpddr_probe_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	register_mtd_chip_driver(&lpddr_chipdrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) static void __exit lpddr_probe_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) 	unregister_mtd_chip_driver(&lpddr_chipdrv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) module_init(lpddr_probe_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) module_exit(lpddr_probe_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) MODULE_AUTHOR("Vasiliy Leonenko <vasiliy.leonenko@gmail.com>");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) MODULE_DESCRIPTION("Driver to probe qinfo flash chips");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235)