Newer
Older
1001
1002
1003
1004
1005
1006
1007
1008
1009
1010
1011
1012
1013
1014
1015
1016
1017
1018
1019
1020
1021
1022
1023
1024
1025
1026
1027
1028
1029
1030
1031
1032
1033
1034
1035
1036
1037
1038
1039
1040
1041
1042
1043
1044
1045
1046
1047
1048
1049
1050
1051
1052
1053
1054
1055
1056
1057
1058
1059
1060
1061
1062
1063
1064
1065
1066
1067
1068
1069
1070
phyregs->miimcfg = MIIMCFG_RESET;
phyregs->miimcfg = MIIMCFG_INIT_VALUE;
while(phyregs->miimind & MIIMIND_BUSY);
for(i=0;cmd->mii_reg != miim_end;i++) {
if(cmd->mii_data == miim_read) {
result = read_phy_reg(priv, cmd->mii_reg);
if(cmd->funct != NULL)
(*(cmd->funct))(result, priv);
} else {
if(cmd->funct != NULL)
result = (*(cmd->funct))(cmd->mii_reg, priv);
else
result = cmd->mii_data;
write_phy_reg(priv, cmd->mii_reg, result);
}
cmd++;
}
}
/* Relocate the function pointers in the phy cmd lists */
static void relocate_cmds(void)
{
struct phy_cmd **cmdlistptr;
struct phy_cmd *cmd;
int i,j,k;
DECLARE_GLOBAL_DATA_PTR;
for(i=0; phy_info[i]; i++) {
/* First thing's first: relocate the pointers to the
* PHY command structures (the structs were done) */
phy_info[i] = (struct phy_info *) ((uint)phy_info[i]
+ gd->reloc_off);
phy_info[i]->name += gd->reloc_off;
phy_info[i]->config =
(struct phy_cmd *)((uint)phy_info[i]->config
+ gd->reloc_off);
phy_info[i]->startup =
(struct phy_cmd *)((uint)phy_info[i]->startup
+ gd->reloc_off);
phy_info[i]->shutdown =
(struct phy_cmd *)((uint)phy_info[i]->shutdown
+ gd->reloc_off);
cmdlistptr = &phy_info[i]->config;
j=0;
for(;cmdlistptr <= &phy_info[i]->shutdown;cmdlistptr++) {
k=0;
for(cmd=*cmdlistptr;cmd->mii_reg != miim_end;cmd++) {
/* Only relocate non-NULL pointers */
if(cmd->funct)
cmd->funct += gd->reloc_off;
k++;
}
j++;
}
}
relocated = 1;
}
#if defined(CONFIG_MII) || (CONFIG_COMMANDS & CFG_CMD_MII) \
&& !defined(BITBANGMII)
struct tsec_private * get_priv_for_phy(unsigned char phyaddr)
{
int i;
for(i=0;i<MAXCONTROLLERS;i++) {
if(privlist[i]->phyaddr == phyaddr)
return privlist[i];
}
return NULL;
}
/*
* Read a MII PHY register.
*
* Returns:
static int tsec_miiphy_read(char *devname, unsigned char addr,
unsigned char reg, unsigned short *value)
unsigned short ret;
struct tsec_private *priv = get_priv_for_phy(addr);
if(NULL == priv) {
printf("Can't read PHY at address %d\n", addr);
return -1;
}
ret = (unsigned short)read_phy_reg(priv, reg);
*value = ret;
return 0;
}
/*
* Write a MII PHY register.
*
* Returns:
static int tsec_miiphy_write(char *devname, unsigned char addr,
unsigned char reg, unsigned short value)
struct tsec_private *priv = get_priv_for_phy(addr);
if(NULL == priv) {
printf("Can't write PHY at address %d\n", addr);
return -1;
}
write_phy_reg(priv, reg, value);
#endif /* defined(CONFIG_MII) || (CONFIG_COMMANDS & CFG_CMD_MII)
&& !defined(BITBANGMII) */