target/linux/ramips/files/drivers/net/ramips_esw.c

   1 #include <linux/ioport.h>
   2
   3 #include <rt305x_regs.h>
   4 #include <rt305x_esw_platform.h>
   5
   6 #define RT305X_ESW_PHY_WRITE            (1 << 13)
   7 #define RT305X_ESW_PHY_TOUT                     (5 * HZ)
   8 #define RT305X_ESW_PHY_CONTROL_0        0xC0
   9 #define RT305X_ESW_PHY_CONTROL_1        0xC4
  10
  11 struct rt305x_esw {
  12         void __iomem *base;
  13         struct rt305x_esw_platform_data *pdata;
  14 };
  15
  16 static inline void
  17 ramips_esw_wr(struct rt305x_esw *esw, u32 val, unsigned reg)
  18 {
  19         __raw_writel(val, esw->base + reg);
  20 }
  21
  22 static inline u32
  23 ramips_esw_rr(struct rt305x_esw *esw, unsigned reg)
  24 {
  25         return __raw_readl(esw->base + reg);
  26 }
  27
  28 u32
  29 mii_mgr_write(struct rt305x_esw *esw, u32 phy_addr, u32 phy_register,
  30               u32 write_data)
  31 {
  32         unsigned long volatile t_start = jiffies;
  33         int ret = 0;
  34
  35         while(1)
  36         {
  37                 if(!(ramips_esw_rr(esw, RT305X_ESW_PHY_CONTROL_1) & (0x1 << 0)))
  38                         break;
  39                 if(time_after(jiffies, t_start + RT305X_ESW_PHY_TOUT))
  40                 {
  41                         ret = 1;
  42                         goto out;
  43                 }
  44         }
  45         ramips_esw_wr(esw, ((write_data & 0xFFFF) << 16) | (phy_register << 8) |
  46                 (phy_addr) | RT305X_ESW_PHY_WRITE, RT305X_ESW_PHY_CONTROL_0);
  47         t_start = jiffies;
  48         while(1)
  49         {
  50                 if(ramips_esw_rr(esw, RT305X_ESW_PHY_CONTROL_1) & (0x1 << 0))
  51                         break;
  52                 if(time_after(jiffies, t_start + RT305X_ESW_PHY_TOUT))
  53                 {
  54                         ret = 1;
  55                         break;
  56                 }
  57         }
  58 out:
  59         if(ret)
  60                 printk(KERN_ERR "ramips_eth: MDIO timeout\n");
  61         return ret;
  62 }
  63
  64 static void
  65 rt305x_esw_hw_init(struct rt305x_esw *esw)
  66 {
  67         int i;
  68
  69         /* vodoo from original driver */
  70         ramips_esw_wr(esw, 0xC8A07850, 0x08);
  71         ramips_esw_wr(esw, 0x00000000, 0xe4);
  72         ramips_esw_wr(esw, 0x00405555, 0x14);
  73         ramips_esw_wr(esw, 0x00002001, 0x50);
  74         ramips_esw_wr(esw, 0x00007f7f, 0x90);
  75         ramips_esw_wr(esw, 0x00007f3f, 0x98);
  76         ramips_esw_wr(esw, 0x00d6500c, 0xcc);
  77         ramips_esw_wr(esw, 0x0008a301, 0x9c);
  78         ramips_esw_wr(esw, 0x02404040, 0x8c);
  79         ramips_esw_wr(esw, 0x00001002, 0x48);
  80         ramips_esw_wr(esw, 0x3f502b28, 0xc8);
  81         ramips_esw_wr(esw, 0x00000000, 0x84);
  82
  83         mii_mgr_write(esw, 0, 31, 0x8000);
  84         for(i = 0; i < 5; i++)
  85         {
  86                 mii_mgr_write(esw, i, 0, 0x3100);   //TX10 waveform coefficient
  87                 mii_mgr_write(esw, i, 26, 0x1601);   //TX10 waveform coefficient
  88                 mii_mgr_write(esw, i, 29, 0x7058);   //TX100/TX10 AD/DA current bias
  89                 mii_mgr_write(esw, i, 30, 0x0018);   //TX100 slew rate control
  90         }
  91         /* PHY IOT */
  92         mii_mgr_write(esw, 0, 31, 0x0);      //select global register
  93         mii_mgr_write(esw, 0, 22, 0x052f);   //tune TP_IDL tail and head waveform
  94         mii_mgr_write(esw, 0, 17, 0x0fe0);   //set TX10 signal amplitude threshold to minimum
  95         mii_mgr_write(esw, 0, 18, 0x40ba);   //set squelch amplitude to higher threshold
  96         mii_mgr_write(esw, 0, 14, 0x65);     //longer TP_IDL tail length
  97         mii_mgr_write(esw, 0, 31, 0x8000);   //select local register
  98
  99         /* set default vlan */
 100         ramips_esw_wr(esw, 0x2001, 0x50);
 101         ramips_esw_wr(esw, 0x504f, 0x70);
 102 }
 103
 104 static int
 105 rt305x_esw_probe(struct platform_device *pdev)
 106 {
 107         struct rt305x_esw_platform_data *pdata;
 108         struct rt305x_esw *esw;
 109         struct resource *res;
 110         int err;
 111
 112         pdata = pdev->dev.platform_data;
 113         if (!pdata)
 114                 return -EINVAL;
 115
 116         res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
 117         if (!res) {
 118                 dev_err(&pdev->dev, "no memory resource found\n");
 119                 return -ENOMEM;
 120         }
 121
 122         esw = kzalloc(sizeof (struct rt305x_esw), GFP_KERNEL);
 123         if (!esw) {
 124                 dev_err(&pdev->dev, "no memory for private data\n");
 125                 return -ENOMEM;
 126         }
 127
 128         esw->base = ioremap(res->start, resource_size(res));
 129         if (!esw->base) {
 130                 dev_err(&pdev->dev, "ioremap failed\n");
 131                 err = -ENOMEM;
 132                 goto free_esw;
 133         }
 134
 135         platform_set_drvdata(pdev, esw);
 136
 137         esw->pdata = pdata;
 138         rt305x_esw_hw_init(esw);
 139
 140         return 0;
 141
 142 free_esw:
 143         kfree(esw);
 144         return err;
 145 }
 146
 147 static int
 148 rt305x_esw_remove(struct platform_device *pdev)
 149 {
 150         struct rt305x_esw *esw;
 151
 152         esw = platform_get_drvdata(pdev);
 153         if (esw) {
 154                 platform_set_drvdata(pdev, NULL);
 155                 iounmap(esw->base);
 156                 kfree(esw);
 157         }
 158
 159         return 0;
 160 }
 161
 162 static struct platform_driver rt305x_esw_driver = {
 163         .probe = rt305x_esw_probe,
 164         .remove = rt305x_esw_remove,
 165         .driver = {
 166                 .name = "rt305x-esw",
 167                 .owner = THIS_MODULE,
 168         },
 169 };
 170
 171 static int __init
 172 rt305x_esw_init(void)
 173 {
 174         return platform_driver_register(&rt305x_esw_driver);
 175 }
 176
 177 static void __exit
 178 rt305x_esw_exit(void)
 179 {
 180         platform_driver_unregister(&rt305x_esw_driver);
 181 }