From 944fe7193e5514cf6233e11ac4b2d9e448da6988 Mon Sep 17 00:00:00 2001 From: Marek Vasut Date: Mon, 13 Jul 2015 00:44:30 +0200 Subject: [PATCH] ddr: altera: Factor out instruction loading from rw_mgr_mem_initialize() Pull the duplicate code out into a separate function. Signed-off-by: Marek Vasut --- drivers/ddr/altera/sequencer.c | 74 +++++++++++++++++----------------- 1 file changed, 37 insertions(+), 37 deletions(-) diff --git a/drivers/ddr/altera/sequencer.c b/drivers/ddr/altera/sequencer.c index b2119a69a1..2d3f44639a 100644 --- a/drivers/ddr/altera/sequencer.c +++ b/drivers/ddr/altera/sequencer.c @@ -840,6 +840,37 @@ static void delay_for_n_mem_clocks(const uint32_t clocks) debug("%s:%d clocks=%u ... end\n", __func__, __LINE__, clocks); } +/** + * rw_mgr_mem_init_load_regs() - Load instruction registers + * @cntr0: Counter 0 value + * @cntr1: Counter 1 value + * @cntr2: Counter 2 value + * @jump: Jump instruction value + * + * Load instruction registers. + */ +static void rw_mgr_mem_init_load_regs(u32 cntr0, u32 cntr1, u32 cntr2, u32 jump) +{ + uint32_t grpaddr = SDR_PHYGRP_RWMGRGRP_ADDRESS | + RW_MGR_RUN_SINGLE_GROUP_OFFSET; + + /* Load counters */ + writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(cntr0), + &sdr_rw_load_mgr_regs->load_cntr0); + writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(cntr1), + &sdr_rw_load_mgr_regs->load_cntr1); + writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(cntr2), + &sdr_rw_load_mgr_regs->load_cntr2); + + /* Load jump address */ + writel(jump, &sdr_rw_load_jump_mgr_regs->load_jump_add0); + writel(jump, &sdr_rw_load_jump_mgr_regs->load_jump_add1); + writel(jump, &sdr_rw_load_jump_mgr_regs->load_jump_add2); + + /* Execute count instruction */ + writel(jump, grpaddr); +} + static void rw_mgr_mem_initialize(void) { uint32_t r; @@ -875,25 +906,9 @@ static void rw_mgr_mem_initialize(void) * One possible solution is n = 0 , a = 256 , b = 106 => a = FF, * b = 6A */ - - /* Load counters */ - writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(SEQ_TINIT_CNTR0_VAL), - &sdr_rw_load_mgr_regs->load_cntr0); - writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(SEQ_TINIT_CNTR1_VAL), - &sdr_rw_load_mgr_regs->load_cntr1); - writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(SEQ_TINIT_CNTR2_VAL), - &sdr_rw_load_mgr_regs->load_cntr2); - - /* Load jump address */ - writel(RW_MGR_INIT_RESET_0_CKE_0, - &sdr_rw_load_jump_mgr_regs->load_jump_add0); - writel(RW_MGR_INIT_RESET_0_CKE_0, - &sdr_rw_load_jump_mgr_regs->load_jump_add1); - writel(RW_MGR_INIT_RESET_0_CKE_0, - &sdr_rw_load_jump_mgr_regs->load_jump_add2); - - /* Execute count instruction */ - writel(RW_MGR_INIT_RESET_0_CKE_0, grpaddr); + rw_mgr_mem_init_load_regs(SEQ_TINIT_CNTR0_VAL, SEQ_TINIT_CNTR1_VAL, + SEQ_TINIT_CNTR2_VAL, + RW_MGR_INIT_RESET_0_CKE_0); /* indicate that memory is stable */ writel(1, &phy_mgr_cfg->reset_mem_stbl); @@ -912,24 +927,9 @@ static void rw_mgr_mem_initialize(void) * One possible solution is n = 2 , a = 131 , b = 256 => a = 83, * b = FF */ - - /* Load counters */ - writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(SEQ_TRESET_CNTR0_VAL), - &sdr_rw_load_mgr_regs->load_cntr0); - writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(SEQ_TRESET_CNTR1_VAL), - &sdr_rw_load_mgr_regs->load_cntr1); - writel(SKIP_DELAY_LOOP_VALUE_OR_ZERO(SEQ_TRESET_CNTR2_VAL), - &sdr_rw_load_mgr_regs->load_cntr2); - - /* Load jump address */ - writel(RW_MGR_INIT_RESET_1_CKE_0, - &sdr_rw_load_jump_mgr_regs->load_jump_add0); - writel(RW_MGR_INIT_RESET_1_CKE_0, - &sdr_rw_load_jump_mgr_regs->load_jump_add1); - writel(RW_MGR_INIT_RESET_1_CKE_0, - &sdr_rw_load_jump_mgr_regs->load_jump_add2); - - writel(RW_MGR_INIT_RESET_1_CKE_0, grpaddr); + rw_mgr_mem_init_load_regs(SEQ_TRESET_CNTR0_VAL, SEQ_TRESET_CNTR1_VAL, + SEQ_TRESET_CNTR2_VAL, + RW_MGR_INIT_RESET_1_CKE_0); /* bring up clock enable */ -- 2.25.1