blob: f96880704d48e68cdf489f8743c01bae6ddfbac9 [file] [log] [blame]
developer930b9e52022-04-15 15:55:45 +08001#include <errno.h>
2#include <stdint.h>
3#include <stdio.h>
4#include <stdlib.h>
5#include <string.h>
6#include <unistd.h>
7
8#include <sys/ioctl.h>
9#include <net/if.h>
10#include <sys/socket.h>
11#include <netinet/in.h>
12#include <arpa/inet.h>
13
14#include <linux/ethtool.h>
15#include <linux/mdio.h>
16#include <linux/sockios.h>
17
18#include "mii_mgr.h"
19
20void show_usage(void)
21{
22 printf("mii_mgr -g -i [ifname] -p [phy number] -r [register number]\n");
23 printf(" Get: mii_mgr -g -p 3 -r 4\n\n");
24 printf("mii_mgr -s -p [phy number] -r [register number] -v [0xvalue]\n");
25 printf(" Set: mii_mgr -s -p 4 -r 1 -v 0xff11\n");
26 printf("#NOTE: Without -i , eth0 is default ifname!\n");
27 printf("----------------------------------------------------------------------------------------\n");
28 printf("Get: mii_mgr_cl45 -g -p [port number] -d [dev number] -r [register number]\n");
29 printf("Example: mii_mgr_cl45 -g -p 3 -d 0x5 -r 0x4\n\n");
30 printf("Set: mii_mgr_cl45 -s -p [port number] -d [dev number] -r [register number] -v [value]\n");
31 printf("Example: mii_mgr_cl45 -s -p 4 -d 0x6 -r 0x1 -v 0xff11\n\n");
32}
33
34static void fill_mii_ioctl(struct mii_ioctl_data *mii, uint16_t phy_id,
35 uint16_t reg_num, uint16_t *val)
36{
37 mii->phy_id = phy_id;
38 mii->reg_num = reg_num;
39 mii->val_in = *val;
40 mii->val_out = 0;
41}
42
43
44static void fill_mtk_mii_ioctl(struct mtk_mii_ioctl_data *mtk_mii, uint16_t phy_id,
45 uint16_t reg_num, unsigned int *val)
46{
47 mtk_mii->phy_id = phy_id;
48 mtk_mii->reg_num = reg_num;
49 mtk_mii->val_in = *val;
50 mtk_mii->val_out = 0;
51}
52
53static int __phy_op(char *ifname, uint16_t phy_id, uint16_t reg_num, unsigned int *val, uint16_t cmd, int is_priv)
54{
55 static int sd = -1;
56
57 struct ifreq ifr;
58 struct mii_ioctl_data mii;
59 struct mtk_mii_ioctl_data mtk_mii;
60 int err;
61
62 if (sd < 0)
63 sd = socket(AF_INET, SOCK_DGRAM, 0);
64
65 if (sd < 0)
66 return sd;
67
68 strncpy(ifr.ifr_name, ifname, sizeof(ifr.ifr_name) - 1);
69 ifr.ifr_name[sizeof(ifr.ifr_name) - 1] = '\0';
70
71 if (is_priv) {
72 fill_mtk_mii_ioctl(&mtk_mii, phy_id, reg_num, val);
73 ifr.ifr_data = (char *)&mtk_mii;
74 } else {
75 fill_mii_ioctl(&mii, phy_id, reg_num, (uint16_t *)val);
76 ifr.ifr_data = (char *)&mii;
77 }
78
79 err = ioctl(sd, cmd, &ifr);
80 if (err)
81 return -errno;
82
83 if ((cmd == MTKETH_MII_WRITE) || (cmd == MTKETH_MII_WRITE_CL45) ||
84 (cmd == SIOCSMIIREG))
85 *val = (is_priv) ? mtk_mii.val_in : mii.val_in;
86 else
87 *val = (is_priv) ? mtk_mii.val_out : mii.val_out;
88
89 return 0;
90}
91
92int main(int argc, char *argv[])
93{
94 int opt;
95 char options[] = "gsui:p:d:r:v:?t";
96 int is_write = 0,is_cl45 = 0;
97 int is_priv = 1;
98 unsigned int port=0, dev=0,reg_num=0,val=0;
99 char ifname[IFNAMSIZ]="eth0";
100 uint16_t phy_id=0;
101 uint16_t cmd;
102
103
104 if (argc < 6) {
105 show_usage();
106 return 0;
107 }
108
109 while ((opt = getopt(argc, argv, options)) != -1) {
110 switch (opt) {
111 case 'g':
112 is_write=0;
113 break;
114 case 's':
115 is_write=1;
116 break;
117 case 'u':
118 is_priv = 0;
119 break;
120 case 'i':
121 strncpy(ifname, optarg, IFNAMSIZ);
122 ifname[IFNAMSIZ - 1] = '\0';
123 break;
124 case 'p':
125 port = strtoul(optarg, NULL, 16);
126 break;
127 case 'd':
128 dev = strtoul(optarg, NULL, 16);
129 is_cl45 = 1;
130 break;
131 case 'r':
132 reg_num = strtoul(optarg, NULL, 16);
133 break;
134
135 case 'v':
136 val = strtoul(optarg, NULL, 16);
137 break;
138 case '?':
139 show_usage();
140 break;
141 }
142 }
143
144 if(is_cl45)
145 phy_id = mdio_phy_id_c45(port, dev);
146 else
147 phy_id = port;
148
149 if(is_write) {
150 if (is_priv)
151 cmd = (is_cl45) ? MTKETH_MII_WRITE_CL45 :
152 MTKETH_MII_WRITE;
153 else
154 cmd = SIOCSMIIREG;
155
156 __phy_op(ifname,phy_id,reg_num, &val, cmd, is_priv);
157
158 if(is_cl45)
159 printf("Set: port%x dev%Xh_reg%Xh = 0x%04X\n",port, dev, reg_num, val);
160 else
161 printf("Set: phy[%x].reg[%x] = %04x\n",port, reg_num, val);
162 }
163 else {
164 if (is_priv)
165 cmd = (is_cl45) ? MTKETH_MII_READ_CL45 :
166 MTKETH_MII_READ;
167 else
168 cmd = SIOCGMIIREG;
169
170 __phy_op(ifname,phy_id,reg_num, &val, cmd, is_priv);
171
172 if(is_cl45)
173 printf("Get: port%x dev%Xh_reg%Xh = 0x%04X\n",port, dev, reg_num, val);
174 else
175 printf("Get: phy[%x].reg[%x] = %04x\n",port, reg_num, val);
176
177 }
178
179 return 0;
180}