主要功能
代码
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <linux/mii.h>
#include <sys/types.h>
#include <sys/socket.h>
#include <sys/ioctl.h>
#include <net/if.h>
#include <linux/sockios.h>
#include <linux/types.h>
#include <netinet/in.h>
#include <unistd.h>
#define retcheck(ret) \
if(ret < 0) { \
printf("%m! \"%s\" : line: %d\n", __func__, __LINE__); \
goto lab; \
}
#define help(str) \
printf("mdio:\n"); \
printf("For example:\n"); \
printf("%s eth0 read 1\n", str); \
printf("%s eth0 write 1 0x12\n\n", str); \
exit(0);
int main(int argc, char *argv[])
{
if(argc < 3 || !strcmp(argv[1], "-h")) {
help(argv[0]);
}
if(!strcmp(argv[2], "read") && argc != 4) {
help(argv[0]);
}
if(!strcmp(argv[2], "write") && argc != 5) {
help(argv[0]);
}
struct mii_ioctl_data *mii = NULL;
struct ifreq ifr;
int ret;
memset(&ifr, 0, sizeof(ifr));
strncpy(ifr.ifr_name, argv[1], IFNAMSIZ - 1);
int sockfd = socket(PF_LOCAL, SOCK_DGRAM, 0);
retcheck(sockfd);
ret = ioctl(sockfd, SIOCGMIIPHY, &ifr);
retcheck(ret);
mii = (struct mii_ioctl_data*)&ifr.ifr_data;
if(!strcmp(argv[2], "read")) {
mii->reg_num = (uint16_t)strtoul(argv[3], NULL, 0);
ret = ioctl(sockfd, SIOCGMIIREG, &ifr);
retcheck(ret);
printf("PHY read ID: 0x%x REG: 0x%x value : 0x%x\n\n", mii->phy_id, mii->reg_num, mii->val_out);
} else if(!strcmp(argv[2], "write")) {
mii->reg_num = (uint16_t)strtoul(argv[3], NULL, 0);
mii->val_in = (uint16_t)strtoul(argv[4], NULL, 0);
ret = ioctl(sockfd, SIOCSMIIREG, &ifr);
retcheck(ret);
printf("PHY write ID: 0x%x REG: 0x%x value : 0x%x\n\n", mii->phy_id, mii->reg_num, mii->val_in);
}
lab:
close(sockfd);
return 0;
}