stmmac: move hw init in the probe (v2)
[linux-2.6.git] / drivers / net / ethernet / stmicro / stmmac / stmmac_pci.c
1 /*******************************************************************************
2   This contains the functions to handle the pci driver.
3
4   Copyright (C) 2011-2012  Vayavya Labs Pvt Ltd
5
6   This program is free software; you can redistribute it and/or modify it
7   under the terms and conditions of the GNU General Public License,
8   version 2, as published by the Free Software Foundation.
9
10   This program is distributed in the hope it will be useful, but WITHOUT
11   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
12   FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
13   more details.
14
15   You should have received a copy of the GNU General Public License along with
16   this program; if not, write to the Free Software Foundation, Inc.,
17   51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
18
19   The full GNU General Public License is included in this distribution in
20   the file called "COPYING".
21
22   Author: Rayagond Kokatanur <rayagond@vayavyalabs.com>
23   Author: Giuseppe Cavallaro <peppe.cavallaro@st.com>
24 *******************************************************************************/
25
26 #include <linux/pci.h>
27 #include "stmmac.h"
28
29 struct plat_stmmacenet_data plat_dat;
30 struct stmmac_mdio_bus_data mdio_data;
31
32 static void stmmac_default_data(void)
33 {
34         memset(&plat_dat, 0, sizeof(struct plat_stmmacenet_data));
35         plat_dat.bus_id = 1;
36         plat_dat.phy_addr = 0;
37         plat_dat.interface = PHY_INTERFACE_MODE_GMII;
38         plat_dat.pbl = 32;
39         plat_dat.clk_csr = 2;   /* clk_csr_i = 20-35MHz & MDC = clk_csr_i/16 */
40         plat_dat.has_gmac = 1;
41         plat_dat.force_sf_dma_mode = 1;
42
43         mdio_data.bus_id = 1;
44         mdio_data.phy_reset = NULL;
45         mdio_data.phy_mask = 0;
46         plat_dat.mdio_bus_data = &mdio_data;
47 }
48
49 /**
50  * stmmac_pci_probe
51  *
52  * @pdev: pci device pointer
53  * @id: pointer to table of device id/id's.
54  *
55  * Description: This probing function gets called for all PCI devices which
56  * match the ID table and are not "owned" by other driver yet. This function
57  * gets passed a "struct pci_dev *" for each device whose entry in the ID table
58  * matches the device. The probe functions returns zero when the driver choose
59  * to take "ownership" of the device or an error code(-ve no) otherwise.
60  */
61 static int __devinit stmmac_pci_probe(struct pci_dev *pdev,
62                                       const struct pci_device_id *id)
63 {
64         int ret = 0;
65         void __iomem *addr = NULL;
66         struct stmmac_priv *priv = NULL;
67         int i;
68
69         /* Enable pci device */
70         ret = pci_enable_device(pdev);
71         if (ret) {
72                 pr_err("%s : ERROR: failed to enable %s device\n", __func__,
73                        pci_name(pdev));
74                 return ret;
75         }
76         if (pci_request_regions(pdev, STMMAC_RESOURCE_NAME)) {
77                 pr_err("%s: ERROR: failed to get PCI region\n", __func__);
78                 ret = -ENODEV;
79                 goto err_out_req_reg_failed;
80         }
81
82         /* Get the base address of device */
83         for (i = 0; i <= 5; i++) {
84                 if (pci_resource_len(pdev, i) == 0)
85                         continue;
86                 addr = pci_iomap(pdev, i, 0);
87                 if (addr == NULL) {
88                         pr_err("%s: ERROR: cannot map regiser memory, aborting",
89                                __func__);
90                         ret = -EIO;
91                         goto err_out_map_failed;
92                 }
93                 break;
94         }
95         pci_set_master(pdev);
96
97         stmmac_default_data();
98
99         priv = stmmac_dvr_probe(&(pdev->dev), &plat_dat, addr);
100         if (!priv) {
101                 pr_err("%s: main driver probe failed", __func__);
102                 goto err_out;
103         }
104         priv->dev->irq = pdev->irq;
105         priv->wol_irq = pdev->irq;
106
107         pci_set_drvdata(pdev, priv->dev);
108
109         pr_debug("STMMAC platform driver registration completed");
110
111         return 0;
112
113 err_out:
114         pci_clear_master(pdev);
115 err_out_map_failed:
116         pci_release_regions(pdev);
117 err_out_req_reg_failed:
118         pci_disable_device(pdev);
119
120         return ret;
121 }
122
123 /**
124  * stmmac_dvr_remove
125  *
126  * @pdev: platform device pointer
127  * Description: this function calls the main to free the net resources
128  * and releases the PCI resources.
129  */
130 static void __devexit stmmac_pci_remove(struct pci_dev *pdev)
131 {
132         struct net_device *ndev = pci_get_drvdata(pdev);
133         struct stmmac_priv *priv = netdev_priv(ndev);
134
135         stmmac_dvr_remove(ndev);
136
137         pci_set_drvdata(pdev, NULL);
138         pci_iounmap(pdev, priv->ioaddr);
139         pci_release_regions(pdev);
140         pci_disable_device(pdev);
141 }
142
143 #ifdef CONFIG_PM
144 static int stmmac_pci_suspend(struct pci_dev *pdev, pm_message_t state)
145 {
146         struct net_device *ndev = pci_get_drvdata(pdev);
147         int ret;
148
149         ret = stmmac_suspend(ndev);
150         pci_save_state(pdev);
151         pci_set_power_state(pdev, pci_choose_state(pdev, state));
152
153         return ret;
154 }
155
156 static int stmmac_pci_resume(struct pci_dev *pdev)
157 {
158         struct net_device *ndev = pci_get_drvdata(pdev);
159
160         pci_set_power_state(pdev, PCI_D0);
161         pci_restore_state(pdev);
162
163         return stmmac_resume(ndev);
164 }
165 #endif
166
167 #define STMMAC_VENDOR_ID 0x700
168 #define STMMAC_DEVICE_ID 0x1108
169
170 static DEFINE_PCI_DEVICE_TABLE(stmmac_id_table) = {
171         {PCI_DEVICE(STMMAC_VENDOR_ID, STMMAC_DEVICE_ID)},
172         {PCI_DEVICE(PCI_VENDOR_ID_STMICRO, PCI_DEVICE_ID_STMICRO_MAC)},
173         {}
174 };
175
176 MODULE_DEVICE_TABLE(pci, stmmac_id_table);
177
178 static struct pci_driver stmmac_driver = {
179         .name = STMMAC_RESOURCE_NAME,
180         .id_table = stmmac_id_table,
181         .probe = stmmac_pci_probe,
182         .remove = __devexit_p(stmmac_pci_remove),
183 #ifdef CONFIG_PM
184         .suspend = stmmac_pci_suspend,
185         .resume = stmmac_pci_resume,
186 #endif
187 };
188
189 /**
190  * stmmac_init_module - Entry point for the driver
191  * Description: This function is the entry point for the driver.
192  */
193 static int __init stmmac_init_module(void)
194 {
195         int ret;
196
197         ret = pci_register_driver(&stmmac_driver);
198         if (ret < 0)
199                 pr_err("%s: ERROR: driver registration failed\n", __func__);
200
201         return ret;
202 }
203
204 /**
205  * stmmac_cleanup_module - Cleanup routine for the driver
206  * Description: This function is the cleanup routine for the driver.
207  */
208 static void __exit stmmac_cleanup_module(void)
209 {
210         pci_unregister_driver(&stmmac_driver);
211 }
212
213 module_init(stmmac_init_module);
214 module_exit(stmmac_cleanup_module);
215
216 MODULE_DESCRIPTION("STMMAC 10/100/1000 Ethernet PCI driver");
217 MODULE_AUTHOR("Rayagond Kokatanur <rayagond.kokatanur@vayavyalabs.com>");
218 MODULE_AUTHOR("Giuseppe Cavallaro <peppe.cavallaro@st.com>");
219 MODULE_LICENSE("GPL");