openwrtv3/target/linux/ramips/files/drivers/usb/host/mtk-phy.c

103 lines
3 KiB
C
Raw Normal View History

#include <linux/gfp.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#define U3_PHY_LIB
#include "mtk-phy.h"
#ifdef CONFIG_PROJECT_7621
#include "mtk-phy-7621.h"
#endif
#ifdef CONFIG_PROJECT_PHY
static struct u3phy_operator project_operators = {
.init = phy_init,
.change_pipe_phase = phy_change_pipe_phase,
.eyescan_init = eyescan_init,
.eyescan = phy_eyescan,
.u2_slew_rate_calibration = u2_slew_rate_calibration,
};
#endif
PHY_INT32 u3phy_init(){
#ifndef CONFIG_PROJECT_PHY
PHY_INT32 u3phy_version;
#endif
if(u3phy != NULL){
return PHY_TRUE;
}
u3phy = kmalloc(sizeof(struct u3phy_info), GFP_NOIO);
#if defined (CONFIG_USB_MT7621_XHCI_PLATFORM)
u3phy_p1 = kmalloc(sizeof(struct u3phy_info), GFP_NOIO);
#endif
#ifdef CONFIG_U3_PHY_GPIO_SUPPORT
u3phy->phyd_version_addr = 0x2000e4;
#if defined (CONFIG_USB_MT7621_XHCI_PLATFORM)
u3phy_p1->phyd_version_addr = 0x2000e4;
#endif
#else
u3phy->phyd_version_addr = U3_PHYD_B2_BASE + 0xe4;
#if defined (CONFIG_USB_MT7621_XHCI_PLATFORM)
u3phy_p1->phyd_version_addr = U3_PHYD_B2_BASE_P1 + 0xe4;
#endif
#endif
#ifdef CONFIG_PROJECT_PHY
u3phy->u2phy_regs = (struct u2phy_reg *)U2_PHY_BASE;
u3phy->u3phyd_regs = (struct u3phyd_reg *)U3_PHYD_BASE;
u3phy->u3phyd_bank2_regs = (struct u3phyd_bank2_reg *)U3_PHYD_B2_BASE;
u3phy->u3phya_regs = (struct u3phya_reg *)U3_PHYA_BASE;
u3phy->u3phya_da_regs = (struct u3phya_da_reg *)U3_PHYA_DA_BASE;
u3phy->sifslv_chip_regs = (struct sifslv_chip_reg *)SIFSLV_CHIP_BASE;
u3phy->sifslv_fm_regs = (struct sifslv_fm_feg *)SIFSLV_FM_FEG_BASE;
u3phy_ops = &project_operators;
#if defined (CONFIG_USB_MT7621_XHCI_PLATFORM)
u3phy_p1->u2phy_regs = (struct u2phy_reg *)U2_PHY_BASE_P1;
u3phy_p1->u3phyd_regs = (struct u3phyd_reg *)U3_PHYD_BASE_P1;
u3phy_p1->u3phyd_bank2_regs = (struct u3phyd_bank2_reg *)U3_PHYD_B2_BASE_P1;
u3phy_p1->u3phya_regs = (struct u3phya_reg *)U3_PHYA_BASE_P1;
u3phy_p1->u3phya_da_regs = (struct u3phya_da_reg *)U3_PHYA_DA_BASE_P1;
u3phy_p1->sifslv_chip_regs = (struct sifslv_chip_reg *)SIFSLV_CHIP_BASE;
u3phy_p1->sifslv_fm_regs = (struct sifslv_fm_feg *)SIFSLV_FM_FEG_BASE;
#endif
#endif
return PHY_TRUE;
}
PHY_INT32 U3PhyWriteField8(PHY_INT32 addr, PHY_INT32 offset, PHY_INT32 mask, PHY_INT32 value){
PHY_INT8 cur_value;
PHY_INT8 new_value;
cur_value = U3PhyReadReg8(addr);
new_value = (cur_value & (~mask)) | (value << offset);
//udelay(i2cdelayus);
U3PhyWriteReg8(addr, new_value);
return PHY_TRUE;
}
PHY_INT32 U3PhyWriteField32(PHY_INT32 addr, PHY_INT32 offset, PHY_INT32 mask, PHY_INT32 value){
PHY_INT32 cur_value;
PHY_INT32 new_value;
cur_value = U3PhyReadReg32(addr);
new_value = (cur_value & (~mask)) | ((value << offset) & mask);
U3PhyWriteReg32(addr, new_value);
//DRV_MDELAY(100);
return PHY_TRUE;
}
PHY_INT32 U3PhyReadField8(PHY_INT32 addr,PHY_INT32 offset,PHY_INT32 mask){
return ((U3PhyReadReg8(addr) & mask) >> offset);
}
PHY_INT32 U3PhyReadField32(PHY_INT32 addr, PHY_INT32 offset, PHY_INT32 mask){
return ((U3PhyReadReg32(addr) & mask) >> offset);
}