125 bool gemini_sata_bridge_enabled(struct sata_gemini *sg, bool is_ata1)  in gemini_sata_bridge_enabled()  argument
127 	if (!sg->sata_bridge)  in gemini_sata_bridge_enabled()
133 	if ((sg->muxmode == GEMINI_MUXMODE_2) &&  in gemini_sata_bridge_enabled()
136 	if ((sg->muxmode == GEMINI_MUXMODE_3) &&  in gemini_sata_bridge_enabled()
144 enum gemini_muxmode gemini_sata_get_muxmode(struct sata_gemini *sg)  in gemini_sata_get_muxmode()  argument
146 	return sg->muxmode;  in gemini_sata_get_muxmode()
150 static int gemini_sata_setup_bridge(struct sata_gemini *sg,  in gemini_sata_setup_bridge()  argument
160 		if (sg->muxmode == GEMINI_MUXMODE_2)  in gemini_sata_setup_bridge()
162 		writel(val, sg->base + GEMINI_SATA0_CTRL);  in gemini_sata_setup_bridge()
166 		if (sg->muxmode == GEMINI_MUXMODE_3)  in gemini_sata_setup_bridge()
168 		writel(val, sg->base + GEMINI_SATA1_CTRL);  in gemini_sata_setup_bridge()
179 			val = readl(sg->base + GEMINI_SATA0_STATUS);  in gemini_sata_setup_bridge()
181 			val = readl(sg->base + GEMINI_SATA1_STATUS);  in gemini_sata_setup_bridge()
188 	dev_info(sg->dev, "SATA%d PHY %s\n", bridge,  in gemini_sata_setup_bridge()
194 int gemini_sata_start_bridge(struct sata_gemini *sg, unsigned int bridge)  in gemini_sata_start_bridge()  argument
200 		pclk = sg->sata0_pclk;  in gemini_sata_start_bridge()
202 		pclk = sg->sata1_pclk;  in gemini_sata_start_bridge()
207 	ret = gemini_sata_setup_bridge(sg, bridge);  in gemini_sata_start_bridge()
215 void gemini_sata_stop_bridge(struct sata_gemini *sg, unsigned int bridge)  in gemini_sata_stop_bridge()  argument
218 		clk_disable(sg->sata0_pclk);  in gemini_sata_stop_bridge()
220 		clk_disable(sg->sata1_pclk);  in gemini_sata_stop_bridge()
224 int gemini_sata_reset_bridge(struct sata_gemini *sg,  in gemini_sata_reset_bridge()  argument
228 		reset_control_reset(sg->sata0_reset);  in gemini_sata_reset_bridge()
230 		reset_control_reset(sg->sata1_reset);  in gemini_sata_reset_bridge()
232 	return gemini_sata_setup_bridge(sg, bridge);  in gemini_sata_reset_bridge()
236 static int gemini_sata_bridge_init(struct sata_gemini *sg)  in gemini_sata_bridge_init()  argument
238 	struct device *dev = sg->dev;  in gemini_sata_bridge_init()
242 	sg->sata0_pclk = devm_clk_get(dev, "SATA0_PCLK");  in gemini_sata_bridge_init()
243 	if (IS_ERR(sg->sata0_pclk)) {  in gemini_sata_bridge_init()
247 	sg->sata1_pclk = devm_clk_get(dev, "SATA1_PCLK");  in gemini_sata_bridge_init()
248 	if (IS_ERR(sg->sata1_pclk)) {  in gemini_sata_bridge_init()
253 	ret = clk_prepare_enable(sg->sata0_pclk);  in gemini_sata_bridge_init()
258 	ret = clk_prepare_enable(sg->sata1_pclk);  in gemini_sata_bridge_init()
261 		clk_disable_unprepare(sg->sata0_pclk);  in gemini_sata_bridge_init()
265 	sg->sata0_reset = devm_reset_control_get_exclusive(dev, "sata0");  in gemini_sata_bridge_init()
266 	if (IS_ERR(sg->sata0_reset)) {  in gemini_sata_bridge_init()
268 		clk_disable_unprepare(sg->sata1_pclk);  in gemini_sata_bridge_init()
269 		clk_disable_unprepare(sg->sata0_pclk);  in gemini_sata_bridge_init()
270 		return PTR_ERR(sg->sata0_reset);  in gemini_sata_bridge_init()
272 	sg->sata1_reset = devm_reset_control_get_exclusive(dev, "sata1");  in gemini_sata_bridge_init()
273 	if (IS_ERR(sg->sata1_reset)) {  in gemini_sata_bridge_init()
275 		clk_disable_unprepare(sg->sata1_pclk);  in gemini_sata_bridge_init()
276 		clk_disable_unprepare(sg->sata0_pclk);  in gemini_sata_bridge_init()
277 		return PTR_ERR(sg->sata1_reset);  in gemini_sata_bridge_init()
280 	sata_id = readl(sg->base + GEMINI_SATA_ID);  in gemini_sata_bridge_init()
281 	sata_phy_id = readl(sg->base + GEMINI_SATA_PHY_ID);  in gemini_sata_bridge_init()
282 	sg->sata_bridge = true;  in gemini_sata_bridge_init()
283 	clk_disable(sg->sata0_pclk);  in gemini_sata_bridge_init()
284 	clk_disable(sg->sata1_pclk);  in gemini_sata_bridge_init()
318 	struct sata_gemini *sg;  in gemini_sata_probe()  local
326 	sg = devm_kzalloc(dev, sizeof(*sg), GFP_KERNEL);  in gemini_sata_probe()
327 	if (!sg)  in gemini_sata_probe()
329 	sg->dev = dev;  in gemini_sata_probe()
335 	sg->base = devm_ioremap_resource(dev, res);  in gemini_sata_probe()
336 	if (IS_ERR(sg->base))  in gemini_sata_probe()
337 		return PTR_ERR(sg->base);  in gemini_sata_probe()
347 		ret = gemini_sata_bridge_init(sg);  in gemini_sata_probe()
353 		sg->ide_pins = true;  in gemini_sata_probe()
355 	if (!sg->sata_bridge && !sg->ide_pins) {  in gemini_sata_probe()
371 	sg->muxmode = muxmode;  in gemini_sata_probe()
387 	if (sg->ide_pins) {  in gemini_sata_probe()
394 	platform_set_drvdata(pdev, sg);  in gemini_sata_probe()
395 	sg_singleton = sg;  in gemini_sata_probe()
400 	if (sg->sata_bridge) {  in gemini_sata_probe()
401 		clk_unprepare(sg->sata1_pclk);  in gemini_sata_probe()
402 		clk_unprepare(sg->sata0_pclk);  in gemini_sata_probe()
409 	struct sata_gemini *sg = platform_get_drvdata(pdev);  in gemini_sata_remove()  local
411 	if (sg->sata_bridge) {  in gemini_sata_remove()
412 		clk_unprepare(sg->sata1_pclk);  in gemini_sata_remove()
413 		clk_unprepare(sg->sata0_pclk);  in gemini_sata_remove()