Donate to e Foundation | Murena handsets with /e/OS | Own a part of Murena! Learn more

Commit f3066919 authored by Bruce Hoo's avatar Bruce Hoo Committed by Gerrit - the friendly Code Review server
Browse files

disp: msm: add func to parse pll_codes from dfps_data_region 



Add function to parse pll_codes from dfps_data_region, and the
pll_codes are used as trim_codes for RFI.

Change-Id: I5b16be94a9e47dff515dea036839f74c2ddd8824
Signed-off-by: default avatarBruce Hoo <bingchua@codeaurora.org>
parent 55ce1ad7

msm/dsi/dsi_pll.c

+78 −0
Original line number Diff line number Diff line
@@ -11,6 +11,9 @@ 
#include <linux/err.h>

#include <linux/delay.h>

#include <linux/iopoll.h>

#include <linux/vmalloc.h>

#include <linux/io.h>

#include <linux/of_address.h>

#include "dsi_pll.h"



static int dsi_pll_clock_register(struct platform_device *pdev,
@@ -51,6 +54,78 @@ static inline int dsi_pll_get_ioresources(struct platform_device *pdev, 
	return rc;

}



static void dsi_pll_free_bootmem(u32 mem_addr, u32 size)

{

	unsigned long pfn_start, pfn_end, pfn_idx;



	pfn_start = mem_addr >> PAGE_SHIFT;

	pfn_end = (mem_addr + size) >> PAGE_SHIFT;

	for (pfn_idx = pfn_start; pfn_idx < pfn_end; pfn_idx++)

		free_reserved_page(pfn_to_page(pfn_idx));

}



static void dsi_pll_parse_dfps(struct platform_device *pdev,

				struct dsi_pll_resource *pll_res)

{

	struct device_node *pnode = NULL;

	const u32 *addr;

	struct vm_struct *area = NULL;

	u64 size;

	u32 offsets[2];

	unsigned long virt_add = 0;



	pnode = of_parse_phandle(pdev->dev.of_node, "memory-region", 0);

	if (IS_ERR_OR_NULL(pnode)) {

		DSI_PLL_INFO(pll_res, "of_parse_phandle failed\n");

		goto node_err;

	}



	addr = of_get_address(pnode, 0, &size, NULL);

	if (!addr) {

		DSI_PLL_ERR(pll_res,

			"failed to parse the dfps memory address\n");

		goto node_err;

	}



	/* maintain compatibility for 32/64 bit */

	offsets[0] = (u32) of_read_ulong(addr, 2);

	offsets[1] = (u32) size;



	area = get_vm_area(offsets[1], VM_IOREMAP);

	if (!area) {

		DSI_PLL_ERR(pll_res, "get_vm_area failed\n");

		goto mem_err;

	}



	virt_add = (unsigned long)area->addr;

	if (ioremap_page_range(virt_add, (virt_add + offsets[1]),

			offsets[0], PAGE_KERNEL)) {

		DSI_PLL_ERR(pll_res, "ioremap_page_range failed\n");

		goto mem_err;

	}



	pll_res->dfps = kzalloc(sizeof(struct dfps_info), GFP_KERNEL);

	if (IS_ERR_OR_NULL(pll_res->dfps)) {

		DSI_PLL_ERR(pll_res, "pll_res->dfps allocate failed\n");

		goto mem_err;

	}



	/* memcopy complete dfps structure from kernel virtual memory */

	memcpy_fromio(pll_res->dfps, area->addr, sizeof(struct dfps_info));



mem_err:

	if (virt_add)

		unmap_kernel_range(virt_add, (unsigned long) size);

	if (area)

		vfree(area->addr);

	/* free the dfps memory here */

	dsi_pll_free_bootmem(offsets[0], offsets[1]);



node_err:

	if (pnode)

		of_node_put(pnode);

}



int dsi_pll_init(struct platform_device *pdev, struct dsi_pll_resource **pll)

{

	int rc = 0;
@@ -145,6 +220,9 @@ int dsi_pll_init(struct platform_device *pdev, struct dsi_pll_resource **pll) 
		return -EINVAL;

	}



	if (!(pll_res->index))

		dsi_pll_parse_dfps(pdev, pll_res);



	return rc;



}