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
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
|
#!/usr/bin/python
#
# Copyright 2014-present Facebook. All Rights Reserved.
#
# This program file 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.
#
# You should have received a copy of the GNU General Public License
# along with this program in a file named COPYING; if not, write to the
# Free Software Foundation, Inc.,
# 51 Franklin Street, Fifth Floor,
# Boston, MA 02110-1301 USA
#
from argparse import ArgumentParser
import subprocess
import time
IO_BASE = [ 0x1e660000, 0x1e680000 ]
PHYCR_REG_OFFSET = 0x60
PHYCR_READ_BIT = 0x1 << 26
PHYCR_WRITE_BIT = 0x1 << 27
phycr_reg = lambda mac: IO_BASE[mac - 1] + PHYCR_REG_OFFSET
PHYDATA_REG_OFFSET = 0x64
phydata_reg = lambda mac: IO_BASE[mac - 1] + PHYDATA_REG_OFFSET
devmem_read_cmd = lambda reg: [ 'devmem', hex(reg) ]
devmem_write_cmd = lambda reg, val: [ 'devmem', hex(reg), '32', hex(val)]
def devmem_read(reg):
cmd = devmem_read_cmd(reg)
#print('Cmd: {}'.format(cmd))
out = subprocess.Popen(cmd, stdout=subprocess.PIPE).communicate()[0]
return int(out, 0)
def devmem_write(reg, val):
cmd = devmem_write_cmd(reg, val)
#print('Cmd: {}'.format(cmd))
subprocess.Popen(cmd, stdout=subprocess.PIPE).communicate()[0]
def wait_for_mdio_done(args):
reg = phycr_reg(args.mac)
while devmem_read(reg) & (PHYCR_READ_BIT|PHYCR_WRITE_BIT):
time.sleep(0.010) # 10ms
def read_mdio(args):
reg = phycr_reg(args.mac)
ctrl = devmem_read(reg)
ctrl &= 0x3000003f
ctrl |= (args.phy & 0x1F) << 16
ctrl |= (args.register & 0x1F) << 21
ctrl |= PHYCR_READ_BIT
devmem_write(reg, ctrl)
wait_for_mdio_done(args)
val = devmem_read(phydata_reg(args.mac)) >> 16
print('Read from PHY ({}.{}): {}'
.format(hex(args.phy), hex(args.register), hex(val)))
def write_mdio(args):
ctrl_reg = phycr_reg(args.mac)
ctrl = devmem_read(ctrl_reg)
ctrl &= 0x3000003f
ctrl |= (args.phy & 0x1F) << 16
ctrl |= (args.register & 0x1F) << 21
ctrl |= PHYCR_WRITE_BIT
data_reg = phydata_reg(args.mac)
# write data first
devmem_write(data_reg, args.value)
# then ctrl
devmem_write(ctrl_reg, ctrl)
wait_for_mdio_done(args)
print('Write to PHY ({}.{}): {}'
.format(hex(args.phy), hex(args.register), hex(args.value)))
def auto_int(x):
return int(x, 0)
if __name__ == '__main__':
ap = ArgumentParser()
ap.add_argument('--mac', '-m', type=int, default=2,
help='The MAC')
ap.add_argument('--phy', '-p', type=auto_int, default=0x1f,
help='The PHY address')
subparsers = ap.add_subparsers()
read_parser = subparsers.add_parser('read',
help='read MDIO')
read_parser.set_defaults(func=read_mdio)
read_parser.add_argument('register', type=auto_int,
help='The register to read from')
write_parser = subparsers.add_parser('write',
help='write MDIO')
write_parser.set_defaults(func=write_mdio)
write_parser.add_argument('register', type=auto_int,
help='The register to write to')
write_parser.add_argument('value', type=auto_int,
help='The value to write to')
args = ap.parse_args()
if args.mac != 2 and args.mac != 1:
print("MAC can only be either 1 or 2.")
exit(-1)
if args.phy > 0x1f:
printf("PHY address must be smaller than 0x1f.")
exit(-2)
args.func(args)
|
