103 lines
3.0 KiB
C
103 lines
3.0 KiB
C
#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);
|
|
}
|
|
|