437 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			437 lines
		
	
	
		
			15 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| // SPDX-License-Identifier: GPL-2.0
 | |
| /*
 | |
|  * Copyright (C) 2022 Rockchip Electronics Co., Ltd.
 | |
|  *
 | |
|  */
 | |
| 
 | |
| #include <linux/bitfield.h>
 | |
| #include <linux/debugfs.h>
 | |
| 
 | |
| #include "rkx110_x120.h"
 | |
| #include "rkx110_x120_display.h"
 | |
| #include "rkx120_dsi_tx.h"
 | |
| #include "hal/cru_api.h"
 | |
| 
 | |
| #define PATTERN_GEN_PATTERN_CTRL	0x0000
 | |
| #define PATTERN_START_PCLK		BIT(31)
 | |
| #define PATTERN_START			BIT(30)
 | |
| #define PATTERN_RECTANGLE_H		GENMASK(29, 16)
 | |
| #define PATTERN_RECTANGLE_V		GENMASK(13, 0)
 | |
| #define PATTERN_GEN_PATERN_VH_CFG0	0x0004
 | |
| #define PATTERN_HACT			GENMASK(29, 16)
 | |
| #define PATTERN_VACT			GENMASK(13, 0)
 | |
| #define PATTERN_GEN_PATERN_VH_CFG1	0x0008
 | |
| #define PATTERN_VFP			GENMASK(29, 20)
 | |
| #define PATTERN_VBP			GENMASK(19, 10)
 | |
| #define PATTERN_VSA			GENMASK(9, 0)
 | |
| #define PATTERN_GEN_PATERN_VH_CFG2	0x000C
 | |
| #define PATTERN_HFP			GENMASK(27, 16)
 | |
| #define PATTERN_HBP			GENMASK(11, 0)
 | |
| #define PATTERN_GEN_PATERN_VH_CFG3	0x0010
 | |
| #define PATTERN_HSA			GENMASK(11, 0)
 | |
| #define PATTERN_GEN_VALUE0		0x0014
 | |
| #define PATTERN_GEN_VALUE1		0x0018
 | |
| 
 | |
| static void pattern_gen_config(struct i2c_client *client, struct pattern_gen *pattern_gen,
 | |
| 				struct videomode *vm)
 | |
| {
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 
 | |
| 	serdes->i2c_update_bits(client, pattern_gen->base + PATTERN_GEN_PATTERN_CTRL,
 | |
| 				PATTERN_RECTANGLE_H | PATTERN_RECTANGLE_V,
 | |
| 				FIELD_PREP(PATTERN_RECTANGLE_H, 128) |
 | |
| 				FIELD_PREP(PATTERN_RECTANGLE_V, 128));
 | |
| 
 | |
| 	serdes->i2c_write_reg(client, pattern_gen->base + PATTERN_GEN_PATERN_VH_CFG0,
 | |
| 			      FIELD_PREP(PATTERN_HACT, vm->hactive) |
 | |
| 			      FIELD_PREP(PATTERN_VACT, vm->vactive));
 | |
| 	serdes->i2c_write_reg(client, pattern_gen->base + PATTERN_GEN_PATERN_VH_CFG1,
 | |
| 			      FIELD_PREP(PATTERN_VFP, vm->vfront_porch) |
 | |
| 			      FIELD_PREP(PATTERN_VBP, vm->vback_porch) |
 | |
| 			      FIELD_PREP(PATTERN_VSA, vm->vsync_len));
 | |
| 	serdes->i2c_write_reg(client, pattern_gen->base + PATTERN_GEN_PATERN_VH_CFG2,
 | |
| 			      FIELD_PREP(PATTERN_HFP, vm->hfront_porch) |
 | |
| 			      FIELD_PREP(PATTERN_HBP, vm->hback_porch));
 | |
| 	serdes->i2c_write_reg(client, pattern_gen->base + PATTERN_GEN_PATERN_VH_CFG3,
 | |
| 			      FIELD_PREP(PATTERN_HSA, vm->hsync_len));
 | |
| 
 | |
| 	serdes->i2c_write_reg(client, pattern_gen->link_src_reg,
 | |
| 			      BIT(pattern_gen->link_src_offset + 16) |
 | |
| 			      BIT(pattern_gen->link_src_offset));
 | |
| }
 | |
| 
 | |
| static void pattern_stop_stream(struct pattern_gen *pattern_gen)
 | |
| {
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 
 | |
| 	if (serdes->version != SERDES_V1)
 | |
| 		return;
 | |
| 
 | |
| 	if (pattern_gen->chip != &serdes->chip[DEVICE_LOCAL])
 | |
| 		return;
 | |
| 
 | |
| 	rk_serdes_display_video_start(serdes, pattern_gen->route, false);
 | |
| 
 | |
| 	if (!strcmp(pattern_gen->name, "lvds0")) {
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_D_LVDS0_RKLINK_TX);
 | |
| 	} else if (!strcmp(pattern_gen->name, "lvds1")) {
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_D_LVDS1_RKLINK_TX);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dual-lvds")) {
 | |
| 		rkx110_set_stream_source(serdes, RK_SERDES_RGB_RX, DEVICE_LOCAL);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_2X_LVDS_RKLINK_TX);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_D_LVDS0_RKLINK_TX);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_D_LVDS1_RKLINK_TX);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi0")) {
 | |
| 		serdes->i2c_write_reg(serdes->chip[DEVICE_LOCAL].client, 0x0314,
 | |
| 				      0x1400140);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX111_SRST_RESETN_D_DSI_0_REC_RKLINK_TX);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_D_DSI_0_RKLINK_TX);
 | |
| 		rkx110_linktx_dsi_rec_start(serdes, DEVICE_LOCAL, 0, false);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi1")) {
 | |
| 		serdes->i2c_write_reg(serdes->chip[DEVICE_LOCAL].client, 0x0314,
 | |
| 				      0x2800280);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX111_SRST_RESETN_D_DSI_1_REC_RKLINK_TX);
 | |
| 		hwclk_reset(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 			    RKX110_SRST_RESETN_D_DSI_1_RKLINK_TX);
 | |
| 		rkx110_linktx_dsi_rec_start(serdes, DEVICE_LOCAL, 1, false);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pattern_start_stream(struct pattern_gen *pattern_gen, bool is_pattern_stream)
 | |
| {
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	struct videomode *vm = &pattern_gen->route->vm;
 | |
| 	u32 delay_length;
 | |
| 
 | |
| 	if (serdes->version != SERDES_V1)
 | |
| 		return;
 | |
| 
 | |
| 	if (pattern_gen->chip != &serdes->chip[DEVICE_LOCAL])
 | |
| 		goto out;
 | |
| 
 | |
| 	if (!strcmp(pattern_gen->name, "lvds0")) {
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_D_LVDS0_RKLINK_TX);
 | |
| 	} else if (!strcmp(pattern_gen->name, "lvds1")) {
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_D_LVDS1_RKLINK_TX);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dual-lvds")) {
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_2X_LVDS_RKLINK_TX);
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_D_LVDS0_RKLINK_TX);
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_D_LVDS1_RKLINK_TX);
 | |
| 		rkx110_set_stream_source(serdes, RK_SERDES_DUAL_LVDS_RX,
 | |
| 					 DEVICE_LOCAL);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi0")) {
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_D_DSI_0_RKLINK_TX);
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX111_SRST_RESETN_D_DSI_0_REC_RKLINK_TX);
 | |
| 		serdes->i2c_write_reg(serdes->chip[DEVICE_LOCAL].client, 0x0314,
 | |
| 				      0x1400000);
 | |
| 
 | |
| 		rkx110_linktx_dsi_type_select(serdes, DEVICE_LOCAL, 0,
 | |
| 					      is_pattern_stream ? false : true);
 | |
| 		if (is_pattern_stream)
 | |
| 			delay_length = vm->hsync_len + vm->hback_porch +
 | |
| 				       vm->hactive + vm->hfront_porch;
 | |
| 		else
 | |
| 			delay_length = (vm->vfront_porch + 1) * (vm->hsync_len +
 | |
| 					vm->hback_porch + vm->hactive + vm->hfront_porch);
 | |
| 		rkx110_linktx_dsi_deley_length_config(serdes, DEVICE_LOCAL, 0, delay_length);
 | |
| 		rkx110_linktx_dsi_rec_start(serdes, DEVICE_LOCAL, 0, true);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi1")) {
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX110_SRST_RESETN_D_DSI_1_RKLINK_TX);
 | |
| 		hwclk_reset_deassert(serdes->chip[DEVICE_LOCAL].hwclk,
 | |
| 				     RKX111_SRST_RESETN_D_DSI_1_REC_RKLINK_TX);
 | |
| 		serdes->i2c_write_reg(serdes->chip[DEVICE_LOCAL].client, 0x0314,
 | |
| 				      0x2800000);
 | |
| 
 | |
| 		rkx110_linktx_dsi_type_select(serdes, DEVICE_LOCAL, 1,
 | |
| 					      is_pattern_stream ? false : true);
 | |
| 		if (is_pattern_stream)
 | |
| 			delay_length = vm->hsync_len + vm->hback_porch +
 | |
| 				       vm->hactive + vm->hfront_porch;
 | |
| 		else
 | |
| 			delay_length = (vm->vfront_porch + 1) * (vm->hsync_len +
 | |
| 					vm->hback_porch + vm->hactive + vm->hfront_porch);
 | |
| 		rkx110_linktx_dsi_deley_length_config(serdes, DEVICE_LOCAL, 1, delay_length);
 | |
| 		rkx110_linktx_dsi_rec_start(serdes, DEVICE_LOCAL, 1, true);
 | |
| 	}
 | |
| 
 | |
| 	rk_serdes_display_video_start(serdes, pattern_gen->route, true);
 | |
| 
 | |
| out:
 | |
| 	if (pattern_gen->route->remote0_port0 == RK_SERDES_DSI_TX0)
 | |
| 		rkx120_dsi_tx_reset(serdes, DEVICE_REMOTE0);
 | |
| 	if (pattern_gen->route->remote1_port0 == RK_SERDES_DSI_TX0)
 | |
| 		rkx120_dsi_tx_reset(serdes, DEVICE_REMOTE1);
 | |
| }
 | |
| 
 | |
| static void pattern_switch_clk_to_pattern(struct pattern_gen *pattern_gen, struct videomode *vm)
 | |
| {
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	struct hwclk *hwclk = serdes->chip[DEVICE_LOCAL].hwclk;
 | |
| 
 | |
| 	if (serdes->version != SERDES_V1)
 | |
| 		return;
 | |
| 
 | |
| 	if (pattern_gen->chip != &serdes->chip[DEVICE_LOCAL])
 | |
| 		return;
 | |
| 
 | |
| 	if (!strcmp(pattern_gen->name, "lvds0")) {
 | |
| 		hwclk_set_rate(hwclk, RKX111_CPS_CLK_D_LVDS0_PATTERN_GEN, vm->pixelclock);
 | |
| 		dev_info(serdes->dev, "RKX111_CPS_CLK_D_LVDS0_PATTERN_GEN:%d\n",
 | |
| 			 hwclk_get_rate(hwclk, RKX111_CPS_CLK_D_LVDS0_PATTERN_GEN));
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS0_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS0_RKLINK_TX_SEL_CLK_D_LVDS0_PATTERN_GEN);
 | |
| 	} else if (!strcmp(pattern_gen->name, "lvds1")) {
 | |
| 		hwclk_set_rate(hwclk, RKX111_CPS_CLK_D_LVDS1_PATTERN_GEN, vm->pixelclock);
 | |
| 		dev_info(serdes->dev, "RKX111_CPS_CLK_D_LVDS1_PATTERN_GEN:%d\n",
 | |
| 			 hwclk_get_rate(hwclk, RKX111_CPS_CLK_D_LVDS1_PATTERN_GEN));
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS1_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS1_RKLINK_TX_SEL_CLK_D_LVDS1_PATTERN_GEN);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dual-lvds")) {
 | |
| 		hwclk_set_rate(hwclk, RKX111_CPS_CLK_D_LVDS0_PATTERN_GEN, vm->pixelclock);
 | |
| 		dev_info(serdes->dev, "RKX111_CPS_CLK_D_LVDS0_PATTERN_GEN:%d\n",
 | |
| 			 hwclk_get_rate(hwclk, RKX111_CPS_CLK_D_LVDS0_PATTERN_GEN));
 | |
| 		hwclk_set_rate(hwclk, RKX111_CPS_CLK_D_LVDS1_PATTERN_GEN, vm->pixelclock);
 | |
| 		dev_info(serdes->dev, "RKX111_CPS_CLK_D_LVDS1_PATTERN_GEN:%d\n",
 | |
| 			 hwclk_get_rate(hwclk, RKX111_CPS_CLK_D_LVDS1_PATTERN_GEN));
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS0_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS0_RKLINK_TX_SEL_CLK_D_LVDS0_PATTERN_GEN);
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS1_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS1_RKLINK_TX_SEL_CLK_D_LVDS1_PATTERN_GEN);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi0")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_DSI_0_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_DSI_0_RKLINK_TX_SEL_CLK_D_DSI_0_PATTERN_GEN);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi1")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_DSI_1_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_DSI_1_RKLINK_TX_SEL_CLK_D_DSI_1_PATTERN_GEN);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static void pattern_switch_clk_to_stream(struct pattern_gen *pattern_gen)
 | |
| {
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	struct hwclk *hwclk = serdes->chip[DEVICE_LOCAL].hwclk;
 | |
| 
 | |
| 	if (serdes->version != SERDES_V1)
 | |
| 		return;
 | |
| 
 | |
| 	if (pattern_gen->chip != &serdes->chip[DEVICE_LOCAL])
 | |
| 		return;
 | |
| 
 | |
| 	if (!strcmp(pattern_gen->name, "lvds0")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS0_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS0_RKLINK_TX_SEL_CLK_D_LVDS0_RKLINK_TX_PRE);
 | |
| 	} else if (!strcmp(pattern_gen->name, "lvds1")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS1_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS1_RKLINK_TX_SEL_CLK_D_LVDS1_RKLINK_TX_PRE);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dual-lvds")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS0_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS0_RKLINK_TX_SEL_CLK_D_LVDS0_RKLINK_TX_PRE);
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_LVDS1_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_LVDS1_RKLINK_TX_SEL_CLK_D_LVDS1_RKLINK_TX_PRE);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi0")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_DSI_0_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_DSI_0_RKLINK_TX_SEL_CLK_D_DSI_0_RKLINK_TX_PRE);
 | |
| 	} else if (!strcmp(pattern_gen->name, "dsi1")) {
 | |
| 		hwclk_set_mux(hwclk, RKX111_CLK_D_DSI_1_RKLINK_TX_SEL,
 | |
| 			      RKX111_CLK_D_DSI_1_RKLINK_TX_SEL_CLK_D_DSI_1_RKLINK_TX_PRE);
 | |
| 	}
 | |
| }
 | |
| 
 | |
| static int pattern_get_route(struct pattern_gen *pattern_gen)
 | |
| {
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	struct rk_serdes_route *route;
 | |
| 	int i;
 | |
| 
 | |
| 	for (i = 0; i < serdes->route_nr; i++) {
 | |
| 		route = serdes->route[i];
 | |
| 
 | |
| 		if (pattern_gen->chip == &serdes->chip[DEVICE_LOCAL]) {
 | |
| 			if ((pattern_gen->type == route->local_port0) ||
 | |
| 			    (pattern_gen->type == route->local_port1)) {
 | |
| 				pattern_gen->route = route;
 | |
| 				break;
 | |
| 			}
 | |
| 		}
 | |
| 		if (pattern_gen->chip == &serdes->chip[DEVICE_REMOTE0]) {
 | |
| 			if ((pattern_gen->type == route->remote0_port0) ||
 | |
| 			    (pattern_gen->type == route->remote0_port1)) {
 | |
| 				pattern_gen->route = route;
 | |
| 				break;
 | |
| 			}
 | |
| 		}
 | |
| 
 | |
| 		if (pattern_gen->chip == &serdes->chip[DEVICE_REMOTE1]) {
 | |
| 			if ((pattern_gen->type == route->remote1_port0) ||
 | |
| 			    (pattern_gen->type == route->remote1_port1)) {
 | |
| 				pattern_gen->route = route;
 | |
| 				break;
 | |
| 			}
 | |
| 		}
 | |
| 	}
 | |
| 
 | |
| 	if (i >= serdes->route_nr) {
 | |
| 		dev_info(serdes->dev, "can't find the %s in route\n", pattern_gen->name);
 | |
| 		return -EINVAL;
 | |
| 	}
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static void pattern_gen_enable(struct pattern_gen *pattern_gen)
 | |
| {
 | |
| 	struct i2c_client *client = pattern_gen->chip->client;
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	struct videomode vm;
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = pattern_get_route(pattern_gen);
 | |
| 	if (ret)
 | |
| 		return;
 | |
| 
 | |
| 	memcpy(&vm, &pattern_gen->route->vm, sizeof(vm));
 | |
| 
 | |
| 	pattern_stop_stream(pattern_gen);
 | |
| 	if (!strcmp(pattern_gen->name, "dual-lvds")) {
 | |
| 		struct pattern_gen *lvds0_pat = pattern_gen + 1;
 | |
| 		struct pattern_gen *lvds1_pat = pattern_gen + 2;
 | |
| 
 | |
| 		vm.hactive /= 2;
 | |
| 		vm.hfront_porch /= 2;
 | |
| 		vm.hback_porch /= 2;
 | |
| 		vm.hsync_len /= 2;
 | |
| 		vm.pixelclock /= 2;
 | |
| 
 | |
| 		pattern_switch_clk_to_pattern(pattern_gen, &vm);
 | |
| 		pattern_gen_config(client, lvds0_pat, &vm);
 | |
| 		pattern_gen_config(client, lvds1_pat, &vm);
 | |
| 		serdes->i2c_write_reg(client, pattern_gen->link_src_reg,
 | |
| 				      BIT(pattern_gen->link_src_offset + 16) |
 | |
| 				      BIT(pattern_gen->link_src_offset));
 | |
| 	} else {
 | |
| 		pattern_switch_clk_to_pattern(pattern_gen, &vm);
 | |
| 		pattern_gen_config(client, pattern_gen, &vm);
 | |
| 		serdes->i2c_update_bits(client, pattern_gen->base + PATTERN_GEN_PATTERN_CTRL,
 | |
| 					PATTERN_START_PCLK,
 | |
| 					FIELD_PREP(PATTERN_START_PCLK, 1));
 | |
| 	}
 | |
| 
 | |
| 	pattern_start_stream(pattern_gen, true);
 | |
| }
 | |
| 
 | |
| static void pattern_gen_disable(struct pattern_gen *pattern_gen)
 | |
| {
 | |
| 	struct i2c_client *client = pattern_gen->chip->client;
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	int ret;
 | |
| 
 | |
| 	ret = pattern_get_route(pattern_gen);
 | |
| 	if (ret)
 | |
| 		return;
 | |
| 
 | |
| 	pattern_stop_stream(pattern_gen);
 | |
| 	if (!strcmp(pattern_gen->name, "dual-lvds")) {
 | |
| 		struct pattern_gen *lvds0_pat = pattern_gen + 1;
 | |
| 		struct pattern_gen *lvds1_pat = pattern_gen + 2;
 | |
| 
 | |
| 		serdes->i2c_write_reg(client, lvds0_pat->link_src_reg,
 | |
| 				      BIT(lvds0_pat->link_src_offset + 16));
 | |
| 		serdes->i2c_write_reg(client, lvds1_pat->link_src_reg,
 | |
| 				      BIT(lvds1_pat->link_src_offset + 16));
 | |
| 		serdes->i2c_write_reg(client, pattern_gen->link_src_reg,
 | |
| 				      BIT(pattern_gen->link_src_offset + 16));
 | |
| 	} else {
 | |
| 		serdes->i2c_write_reg(client, pattern_gen->link_src_reg,
 | |
| 				      BIT(pattern_gen->link_src_offset + 16));
 | |
| 		serdes->i2c_update_bits(client, pattern_gen->base + PATTERN_GEN_PATTERN_CTRL,
 | |
| 					PATTERN_START_PCLK,
 | |
| 					FIELD_PREP(PATTERN_START_PCLK, 0));
 | |
| 	}
 | |
| 
 | |
| 	pattern_switch_clk_to_stream(pattern_gen);
 | |
| 	pattern_start_stream(pattern_gen, false);
 | |
| }
 | |
| 
 | |
| static ssize_t pattern_gen_write(struct file *file, const char __user *ubuf,
 | |
| 				 size_t len, loff_t *offp)
 | |
| {
 | |
| 	struct seq_file *m = file->private_data;
 | |
| 	struct pattern_gen *pattern_gen = m->private;
 | |
| 	char buf[5];
 | |
| 
 | |
| 	if (len > sizeof(buf) - 1)
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	if (copy_from_user(buf, ubuf, len))
 | |
| 		return -EFAULT;
 | |
| 
 | |
| 	buf[len] = '\0';
 | |
| 
 | |
| 	if (sysfs_streq(buf, "on"))
 | |
| 		pattern_gen_enable(pattern_gen);
 | |
| 	else if (sysfs_streq(buf, "off"))
 | |
| 		pattern_gen_disable(pattern_gen);
 | |
| 	else
 | |
| 		return -EINVAL;
 | |
| 
 | |
| 	return len;
 | |
| }
 | |
| 
 | |
| static int pattern_gen_show(struct seq_file *m, void *data)
 | |
| {
 | |
| 	struct pattern_gen *pattern_gen = m->private;
 | |
| 	struct i2c_client *client = pattern_gen->chip->client;
 | |
| 	struct rk_serdes *serdes = pattern_gen->chip->serdes;
 | |
| 	u32 reg = 0;
 | |
| 
 | |
| 	serdes->i2c_read_reg(client, pattern_gen->link_src_reg, ®);
 | |
| 	if (reg & BIT(pattern_gen->link_src_offset))
 | |
| 		seq_printf(m, "%s\n", "on");
 | |
| 	else
 | |
| 		seq_printf(m, "%s\n", "off");
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| 
 | |
| static int pattern_gen_open(struct inode *inode, struct file *file)
 | |
| {
 | |
| 	struct pattern_gen *pattern_gen = inode->i_private;
 | |
| 
 | |
| 	return single_open(file, pattern_gen_show, pattern_gen);
 | |
| }
 | |
| 
 | |
| static const struct file_operations pattern_gen_fops = {
 | |
| 	.owner = THIS_MODULE,
 | |
| 	.open = pattern_gen_open,
 | |
| 	.read = seq_read,
 | |
| 	.llseek = seq_lseek,
 | |
| 	.release = single_release,
 | |
| 	.write = pattern_gen_write,
 | |
| };
 | |
| 
 | |
| void rkx110_x120_pattern_gen_debugfs_create_file(struct pattern_gen *pattern_gen,
 | |
| 						 struct rk_serdes_chip *chip,
 | |
| 						 struct dentry *dentry)
 | |
| {
 | |
| 	pattern_gen->chip = chip;
 | |
| 
 | |
| 	debugfs_create_file(pattern_gen->name, 0600, dentry, pattern_gen,
 | |
| 			    &pattern_gen_fops);
 | |
| }
 |