summaryrefslogtreecommitdiff
path: root/src/soc/marvell/mvmap2315/pinmux.c
blob: 159d62e175738d736b0d578dc414b86f4d2d5095 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
/*
 * This file is part of the coreboot project.
 *
 * Copyright (C) 2016 Marvell, Inc.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; version 2 of the License.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 */

#include <stddef.h>
#include <stdint.h>
#include <stdlib.h>

#include <arch/io.h>
#include <soc/pinmux.h>

void set_pinmux(struct mvmap2315_pinmux pinmux)
{
	u32 pad_num;
	u32 reg = 0;

	/* pads < 160 are part of the MCU domain and not handled here
	 * and pads > 231 don't exist
	 */
	if (pinmux.pad < 160 || pinmux.pad > 231)
		return;

	pad_num = pinmux.pad - 160;

	reg |= (pinmux.fun_sel <<
		MVMAP2315_PADWRAP_FUNC_SEL_SHIFT) &
		MVMAP2315_PADWRAP_FUNC_SEL;

	reg |= (pinmux.raw_sel <<
		MVMAP2315_PADWRAP_RAW_SEL_SHIFT) &
		MVMAP2315_PADWRAP_RAW_SEL;

	reg |= (pinmux.dgtb_sel <<
		MVMAP2315_PADWRAP_DGTB_SEL_SHIFT) &
		MVMAP2315_PADWRAP_DGTB_SEL;

	reg |= (pinmux.slew <<
		MVMAP2315_PADWRAP_SLEW_SHIFT) &
		MVMAP2315_PADWRAP_SLEW;

	if (!pinmux.pull_sel) {
		reg &= ~MVMAP2315_PADWRAP_PD_EN;
		reg &= ~MVMAP2315_PADWRAP_PU_EN;
	} else if (pinmux.pull_sel == 1) {
		reg |= MVMAP2315_PADWRAP_PD_EN;
		reg &= ~MVMAP2315_PADWRAP_PU_EN;
	} else if (pinmux.pull_sel == 2) {
		reg &= ~MVMAP2315_PADWRAP_PD_EN;
		reg |= MVMAP2315_PADWRAP_PU_EN;
	}

	write32(&mvmap2315_pinmux->io_pad_piocfg[pad_num], reg);
}