qeth_l2_main.c 53 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980
  1. /*
  2. * Copyright IBM Corp. 2007, 2009
  3. * Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
  4. * Frank Pavlic <fpavlic@de.ibm.com>,
  5. * Thomas Spatzier <tspat@de.ibm.com>,
  6. * Frank Blaschka <frank.blaschka@de.ibm.com>
  7. */
  8. #define KMSG_COMPONENT "qeth"
  9. #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
  10. #include <linux/module.h>
  11. #include <linux/moduleparam.h>
  12. #include <linux/string.h>
  13. #include <linux/errno.h>
  14. #include <linux/kernel.h>
  15. #include <linux/slab.h>
  16. #include <linux/etherdevice.h>
  17. #include <linux/mii.h>
  18. #include <linux/ip.h>
  19. #include <linux/list.h>
  20. #include "qeth_core.h"
  21. #include "qeth_l2.h"
  22. static int qeth_l2_set_offline(struct ccwgroup_device *);
  23. static int qeth_l2_stop(struct net_device *);
  24. static int qeth_l2_send_delmac(struct qeth_card *, __u8 *);
  25. static int qeth_l2_send_setdelmac(struct qeth_card *, __u8 *,
  26. enum qeth_ipa_cmds);
  27. static void qeth_l2_set_multicast_list(struct net_device *);
  28. static int qeth_l2_recover(void *);
  29. static void qeth_bridgeport_query_support(struct qeth_card *card);
  30. static void qeth_bridge_state_change(struct qeth_card *card,
  31. struct qeth_ipa_cmd *cmd);
  32. static void qeth_bridge_host_event(struct qeth_card *card,
  33. struct qeth_ipa_cmd *cmd);
  34. static int qeth_l2_do_ioctl(struct net_device *dev, struct ifreq *rq, int cmd)
  35. {
  36. struct qeth_card *card = dev->ml_priv;
  37. struct mii_ioctl_data *mii_data;
  38. int rc = 0;
  39. if (!card)
  40. return -ENODEV;
  41. if (!qeth_card_hw_is_reachable(card))
  42. return -ENODEV;
  43. if (card->info.type == QETH_CARD_TYPE_OSN)
  44. return -EPERM;
  45. switch (cmd) {
  46. case SIOC_QETH_ADP_SET_SNMP_CONTROL:
  47. rc = qeth_snmp_command(card, rq->ifr_ifru.ifru_data);
  48. break;
  49. case SIOC_QETH_GET_CARD_TYPE:
  50. if ((card->info.type == QETH_CARD_TYPE_OSD ||
  51. card->info.type == QETH_CARD_TYPE_OSM ||
  52. card->info.type == QETH_CARD_TYPE_OSX) &&
  53. !card->info.guestlan)
  54. return 1;
  55. return 0;
  56. break;
  57. case SIOCGMIIPHY:
  58. mii_data = if_mii(rq);
  59. mii_data->phy_id = 0;
  60. break;
  61. case SIOCGMIIREG:
  62. mii_data = if_mii(rq);
  63. if (mii_data->phy_id != 0)
  64. rc = -EINVAL;
  65. else
  66. mii_data->val_out = qeth_mdio_read(dev,
  67. mii_data->phy_id, mii_data->reg_num);
  68. break;
  69. case SIOC_QETH_QUERY_OAT:
  70. rc = qeth_query_oat_command(card, rq->ifr_ifru.ifru_data);
  71. break;
  72. default:
  73. rc = -EOPNOTSUPP;
  74. }
  75. if (rc)
  76. QETH_CARD_TEXT_(card, 2, "ioce%d", rc);
  77. return rc;
  78. }
  79. static int qeth_l2_verify_dev(struct net_device *dev)
  80. {
  81. struct qeth_card *card;
  82. unsigned long flags;
  83. int rc = 0;
  84. read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
  85. list_for_each_entry(card, &qeth_core_card_list.list, list) {
  86. if (card->dev == dev) {
  87. rc = QETH_REAL_CARD;
  88. break;
  89. }
  90. }
  91. read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
  92. return rc;
  93. }
  94. static struct net_device *qeth_l2_netdev_by_devno(unsigned char *read_dev_no)
  95. {
  96. struct qeth_card *card;
  97. struct net_device *ndev;
  98. __u16 temp_dev_no;
  99. unsigned long flags;
  100. struct ccw_dev_id read_devid;
  101. ndev = NULL;
  102. memcpy(&temp_dev_no, read_dev_no, 2);
  103. read_lock_irqsave(&qeth_core_card_list.rwlock, flags);
  104. list_for_each_entry(card, &qeth_core_card_list.list, list) {
  105. ccw_device_get_id(CARD_RDEV(card), &read_devid);
  106. if (read_devid.devno == temp_dev_no) {
  107. ndev = card->dev;
  108. break;
  109. }
  110. }
  111. read_unlock_irqrestore(&qeth_core_card_list.rwlock, flags);
  112. return ndev;
  113. }
  114. static int qeth_setdel_makerc(struct qeth_card *card, int retcode)
  115. {
  116. int rc;
  117. if (retcode)
  118. QETH_CARD_TEXT_(card, 2, "err%04x", retcode);
  119. switch (retcode) {
  120. case IPA_RC_SUCCESS:
  121. rc = 0;
  122. break;
  123. case IPA_RC_L2_UNSUPPORTED_CMD:
  124. rc = -ENOSYS;
  125. break;
  126. case IPA_RC_L2_ADDR_TABLE_FULL:
  127. rc = -ENOSPC;
  128. break;
  129. case IPA_RC_L2_DUP_MAC:
  130. case IPA_RC_L2_DUP_LAYER3_MAC:
  131. rc = -EEXIST;
  132. break;
  133. case IPA_RC_L2_MAC_NOT_AUTH_BY_HYP:
  134. case IPA_RC_L2_MAC_NOT_AUTH_BY_ADP:
  135. rc = -EPERM;
  136. break;
  137. case IPA_RC_L2_MAC_NOT_FOUND:
  138. rc = -ENOENT;
  139. break;
  140. case -ENOMEM:
  141. rc = -ENOMEM;
  142. break;
  143. default:
  144. rc = -EIO;
  145. break;
  146. }
  147. return rc;
  148. }
  149. static int qeth_l2_send_setgroupmac(struct qeth_card *card, __u8 *mac)
  150. {
  151. int rc;
  152. QETH_CARD_TEXT(card, 2, "L2Sgmac");
  153. rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
  154. IPA_CMD_SETGMAC));
  155. if (rc == -EEXIST)
  156. QETH_DBF_MESSAGE(2, "Group MAC %pM already existing on %s\n",
  157. mac, QETH_CARD_IFNAME(card));
  158. else if (rc)
  159. QETH_DBF_MESSAGE(2, "Could not set group MAC %pM on %s: %d\n",
  160. mac, QETH_CARD_IFNAME(card), rc);
  161. return rc;
  162. }
  163. static int qeth_l2_send_delgroupmac(struct qeth_card *card, __u8 *mac)
  164. {
  165. int rc;
  166. QETH_CARD_TEXT(card, 2, "L2Dgmac");
  167. rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
  168. IPA_CMD_DELGMAC));
  169. if (rc)
  170. QETH_DBF_MESSAGE(2,
  171. "Could not delete group MAC %pM on %s: %d\n",
  172. mac, QETH_CARD_IFNAME(card), rc);
  173. return rc;
  174. }
  175. static void qeth_l2_add_mc(struct qeth_card *card, __u8 *mac, int vmac)
  176. {
  177. struct qeth_mc_mac *mc;
  178. int rc;
  179. mc = kmalloc(sizeof(struct qeth_mc_mac), GFP_ATOMIC);
  180. if (!mc)
  181. return;
  182. memcpy(mc->mc_addr, mac, OSA_ADDR_LEN);
  183. mc->mc_addrlen = OSA_ADDR_LEN;
  184. mc->is_vmac = vmac;
  185. if (vmac) {
  186. rc = qeth_setdel_makerc(card,
  187. qeth_l2_send_setdelmac(card, mac, IPA_CMD_SETVMAC));
  188. } else {
  189. rc = qeth_setdel_makerc(card,
  190. qeth_l2_send_setgroupmac(card, mac));
  191. }
  192. if (!rc)
  193. list_add_tail(&mc->list, &card->mc_list);
  194. else
  195. kfree(mc);
  196. }
  197. static void qeth_l2_del_all_mc(struct qeth_card *card, int del)
  198. {
  199. struct qeth_mc_mac *mc, *tmp;
  200. spin_lock_bh(&card->mclock);
  201. list_for_each_entry_safe(mc, tmp, &card->mc_list, list) {
  202. if (del) {
  203. if (mc->is_vmac)
  204. qeth_l2_send_setdelmac(card, mc->mc_addr,
  205. IPA_CMD_DELVMAC);
  206. else
  207. qeth_l2_send_delgroupmac(card, mc->mc_addr);
  208. }
  209. list_del(&mc->list);
  210. kfree(mc);
  211. }
  212. spin_unlock_bh(&card->mclock);
  213. }
  214. static inline int qeth_l2_get_cast_type(struct qeth_card *card,
  215. struct sk_buff *skb)
  216. {
  217. if (card->info.type == QETH_CARD_TYPE_OSN)
  218. return RTN_UNSPEC;
  219. if (is_broadcast_ether_addr(skb->data))
  220. return RTN_BROADCAST;
  221. if (is_multicast_ether_addr(skb->data))
  222. return RTN_MULTICAST;
  223. return RTN_UNSPEC;
  224. }
  225. static void qeth_l2_fill_header(struct qeth_card *card, struct qeth_hdr *hdr,
  226. struct sk_buff *skb, int cast_type)
  227. {
  228. struct vlan_ethhdr *veth = (struct vlan_ethhdr *)skb_mac_header(skb);
  229. memset(hdr, 0, sizeof(struct qeth_hdr));
  230. hdr->hdr.l2.id = QETH_HEADER_TYPE_LAYER2;
  231. /* set byte byte 3 to casting flags */
  232. if (cast_type == RTN_MULTICAST)
  233. hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_MULTICAST;
  234. else if (cast_type == RTN_BROADCAST)
  235. hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_BROADCAST;
  236. else
  237. hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_UNICAST;
  238. hdr->hdr.l2.pkt_length = skb->len-QETH_HEADER_SIZE;
  239. /* VSWITCH relies on the VLAN
  240. * information to be present in
  241. * the QDIO header */
  242. if (veth->h_vlan_proto == __constant_htons(ETH_P_8021Q)) {
  243. hdr->hdr.l2.flags[2] |= QETH_LAYER2_FLAG_VLAN;
  244. hdr->hdr.l2.vlan_id = ntohs(veth->h_vlan_TCI);
  245. }
  246. }
  247. static int qeth_l2_send_setdelvlan_cb(struct qeth_card *card,
  248. struct qeth_reply *reply, unsigned long data)
  249. {
  250. struct qeth_ipa_cmd *cmd;
  251. QETH_CARD_TEXT(card, 2, "L2sdvcb");
  252. cmd = (struct qeth_ipa_cmd *) data;
  253. if (cmd->hdr.return_code) {
  254. QETH_DBF_MESSAGE(2, "Error in processing VLAN %i on %s: 0x%x. "
  255. "Continuing\n", cmd->data.setdelvlan.vlan_id,
  256. QETH_CARD_IFNAME(card), cmd->hdr.return_code);
  257. QETH_CARD_TEXT_(card, 2, "L2VL%4x", cmd->hdr.command);
  258. QETH_CARD_TEXT_(card, 2, "err%d", cmd->hdr.return_code);
  259. }
  260. return 0;
  261. }
  262. static int qeth_l2_send_setdelvlan(struct qeth_card *card, __u16 i,
  263. enum qeth_ipa_cmds ipacmd)
  264. {
  265. struct qeth_ipa_cmd *cmd;
  266. struct qeth_cmd_buffer *iob;
  267. QETH_CARD_TEXT_(card, 4, "L2sdv%x", ipacmd);
  268. iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
  269. if (!iob)
  270. return -ENOMEM;
  271. cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
  272. cmd->data.setdelvlan.vlan_id = i;
  273. return qeth_send_ipa_cmd(card, iob,
  274. qeth_l2_send_setdelvlan_cb, NULL);
  275. }
  276. static void qeth_l2_process_vlans(struct qeth_card *card)
  277. {
  278. struct qeth_vlan_vid *id;
  279. QETH_CARD_TEXT(card, 3, "L2prcvln");
  280. spin_lock_bh(&card->vlanlock);
  281. list_for_each_entry(id, &card->vid_list, list) {
  282. qeth_l2_send_setdelvlan(card, id->vid, IPA_CMD_SETVLAN);
  283. }
  284. spin_unlock_bh(&card->vlanlock);
  285. }
  286. static int qeth_l2_vlan_rx_add_vid(struct net_device *dev,
  287. __be16 proto, u16 vid)
  288. {
  289. struct qeth_card *card = dev->ml_priv;
  290. struct qeth_vlan_vid *id;
  291. int rc;
  292. QETH_CARD_TEXT_(card, 4, "aid:%d", vid);
  293. if (!vid)
  294. return 0;
  295. if (card->info.type == QETH_CARD_TYPE_OSM) {
  296. QETH_CARD_TEXT(card, 3, "aidOSM");
  297. return 0;
  298. }
  299. if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
  300. QETH_CARD_TEXT(card, 3, "aidREC");
  301. return 0;
  302. }
  303. id = kmalloc(sizeof(struct qeth_vlan_vid), GFP_ATOMIC);
  304. if (id) {
  305. id->vid = vid;
  306. rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_SETVLAN);
  307. if (rc) {
  308. kfree(id);
  309. return rc;
  310. }
  311. spin_lock_bh(&card->vlanlock);
  312. list_add_tail(&id->list, &card->vid_list);
  313. spin_unlock_bh(&card->vlanlock);
  314. } else {
  315. return -ENOMEM;
  316. }
  317. return 0;
  318. }
  319. static int qeth_l2_vlan_rx_kill_vid(struct net_device *dev,
  320. __be16 proto, u16 vid)
  321. {
  322. struct qeth_vlan_vid *id, *tmpid = NULL;
  323. struct qeth_card *card = dev->ml_priv;
  324. int rc = 0;
  325. QETH_CARD_TEXT_(card, 4, "kid:%d", vid);
  326. if (card->info.type == QETH_CARD_TYPE_OSM) {
  327. QETH_CARD_TEXT(card, 3, "kidOSM");
  328. return 0;
  329. }
  330. if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
  331. QETH_CARD_TEXT(card, 3, "kidREC");
  332. return 0;
  333. }
  334. spin_lock_bh(&card->vlanlock);
  335. list_for_each_entry(id, &card->vid_list, list) {
  336. if (id->vid == vid) {
  337. list_del(&id->list);
  338. tmpid = id;
  339. break;
  340. }
  341. }
  342. spin_unlock_bh(&card->vlanlock);
  343. if (tmpid) {
  344. rc = qeth_l2_send_setdelvlan(card, vid, IPA_CMD_DELVLAN);
  345. kfree(tmpid);
  346. }
  347. qeth_l2_set_multicast_list(card->dev);
  348. return rc;
  349. }
  350. static int qeth_l2_stop_card(struct qeth_card *card, int recovery_mode)
  351. {
  352. int rc = 0;
  353. QETH_DBF_TEXT(SETUP , 2, "stopcard");
  354. QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
  355. qeth_set_allowed_threads(card, 0, 1);
  356. if (card->read.state == CH_STATE_UP &&
  357. card->write.state == CH_STATE_UP &&
  358. (card->state == CARD_STATE_UP)) {
  359. if (recovery_mode &&
  360. card->info.type != QETH_CARD_TYPE_OSN) {
  361. qeth_l2_stop(card->dev);
  362. } else {
  363. rtnl_lock();
  364. dev_close(card->dev);
  365. rtnl_unlock();
  366. }
  367. card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
  368. card->state = CARD_STATE_SOFTSETUP;
  369. }
  370. if (card->state == CARD_STATE_SOFTSETUP) {
  371. qeth_l2_del_all_mc(card, 0);
  372. qeth_clear_ipacmd_list(card);
  373. card->state = CARD_STATE_HARDSETUP;
  374. }
  375. if (card->state == CARD_STATE_HARDSETUP) {
  376. qeth_qdio_clear_card(card, 0);
  377. qeth_clear_qdio_buffers(card);
  378. qeth_clear_working_pool_list(card);
  379. card->state = CARD_STATE_DOWN;
  380. }
  381. if (card->state == CARD_STATE_DOWN) {
  382. qeth_clear_cmd_buffers(&card->read);
  383. qeth_clear_cmd_buffers(&card->write);
  384. }
  385. return rc;
  386. }
  387. static int qeth_l2_process_inbound_buffer(struct qeth_card *card,
  388. int budget, int *done)
  389. {
  390. int work_done = 0;
  391. struct sk_buff *skb;
  392. struct qeth_hdr *hdr;
  393. unsigned int len;
  394. *done = 0;
  395. WARN_ON_ONCE(!budget);
  396. while (budget) {
  397. skb = qeth_core_get_next_skb(card,
  398. &card->qdio.in_q->bufs[card->rx.b_index],
  399. &card->rx.b_element, &card->rx.e_offset, &hdr);
  400. if (!skb) {
  401. *done = 1;
  402. break;
  403. }
  404. skb->dev = card->dev;
  405. switch (hdr->hdr.l2.id) {
  406. case QETH_HEADER_TYPE_LAYER2:
  407. skb->pkt_type = PACKET_HOST;
  408. skb->protocol = eth_type_trans(skb, skb->dev);
  409. skb->ip_summed = CHECKSUM_NONE;
  410. if (skb->protocol == htons(ETH_P_802_2))
  411. *((__u32 *)skb->cb) = ++card->seqno.pkt_seqno;
  412. len = skb->len;
  413. netif_receive_skb(skb);
  414. break;
  415. case QETH_HEADER_TYPE_OSN:
  416. if (card->info.type == QETH_CARD_TYPE_OSN) {
  417. skb_push(skb, sizeof(struct qeth_hdr));
  418. skb_copy_to_linear_data(skb, hdr,
  419. sizeof(struct qeth_hdr));
  420. len = skb->len;
  421. card->osn_info.data_cb(skb);
  422. break;
  423. }
  424. /* else unknown */
  425. default:
  426. dev_kfree_skb_any(skb);
  427. QETH_CARD_TEXT(card, 3, "inbunkno");
  428. QETH_DBF_HEX(CTRL, 3, hdr, QETH_DBF_CTRL_LEN);
  429. continue;
  430. }
  431. work_done++;
  432. budget--;
  433. card->stats.rx_packets++;
  434. card->stats.rx_bytes += len;
  435. }
  436. return work_done;
  437. }
  438. static int qeth_l2_poll(struct napi_struct *napi, int budget)
  439. {
  440. struct qeth_card *card = container_of(napi, struct qeth_card, napi);
  441. int work_done = 0;
  442. struct qeth_qdio_buffer *buffer;
  443. int done;
  444. int new_budget = budget;
  445. if (card->options.performance_stats) {
  446. card->perf_stats.inbound_cnt++;
  447. card->perf_stats.inbound_start_time = qeth_get_micros();
  448. }
  449. while (1) {
  450. if (!card->rx.b_count) {
  451. card->rx.qdio_err = 0;
  452. card->rx.b_count = qdio_get_next_buffers(
  453. card->data.ccwdev, 0, &card->rx.b_index,
  454. &card->rx.qdio_err);
  455. if (card->rx.b_count <= 0) {
  456. card->rx.b_count = 0;
  457. break;
  458. }
  459. card->rx.b_element =
  460. &card->qdio.in_q->bufs[card->rx.b_index]
  461. .buffer->element[0];
  462. card->rx.e_offset = 0;
  463. }
  464. while (card->rx.b_count) {
  465. buffer = &card->qdio.in_q->bufs[card->rx.b_index];
  466. if (!(card->rx.qdio_err &&
  467. qeth_check_qdio_errors(card, buffer->buffer,
  468. card->rx.qdio_err, "qinerr")))
  469. work_done += qeth_l2_process_inbound_buffer(
  470. card, new_budget, &done);
  471. else
  472. done = 1;
  473. if (done) {
  474. if (card->options.performance_stats)
  475. card->perf_stats.bufs_rec++;
  476. qeth_put_buffer_pool_entry(card,
  477. buffer->pool_entry);
  478. qeth_queue_input_buffer(card, card->rx.b_index);
  479. card->rx.b_count--;
  480. if (card->rx.b_count) {
  481. card->rx.b_index =
  482. (card->rx.b_index + 1) %
  483. QDIO_MAX_BUFFERS_PER_Q;
  484. card->rx.b_element =
  485. &card->qdio.in_q
  486. ->bufs[card->rx.b_index]
  487. .buffer->element[0];
  488. card->rx.e_offset = 0;
  489. }
  490. }
  491. if (work_done >= budget)
  492. goto out;
  493. else
  494. new_budget = budget - work_done;
  495. }
  496. }
  497. napi_complete(napi);
  498. if (qdio_start_irq(card->data.ccwdev, 0))
  499. napi_schedule(&card->napi);
  500. out:
  501. if (card->options.performance_stats)
  502. card->perf_stats.inbound_time += qeth_get_micros() -
  503. card->perf_stats.inbound_start_time;
  504. return work_done;
  505. }
  506. static int qeth_l2_send_setdelmac(struct qeth_card *card, __u8 *mac,
  507. enum qeth_ipa_cmds ipacmd)
  508. {
  509. struct qeth_ipa_cmd *cmd;
  510. struct qeth_cmd_buffer *iob;
  511. QETH_CARD_TEXT(card, 2, "L2sdmac");
  512. iob = qeth_get_ipacmd_buffer(card, ipacmd, QETH_PROT_IPV4);
  513. if (!iob)
  514. return -ENOMEM;
  515. cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
  516. cmd->data.setdelmac.mac_length = OSA_ADDR_LEN;
  517. memcpy(&cmd->data.setdelmac.mac, mac, OSA_ADDR_LEN);
  518. return qeth_send_ipa_cmd(card, iob, NULL, NULL);
  519. }
  520. static int qeth_l2_send_setmac(struct qeth_card *card, __u8 *mac)
  521. {
  522. int rc;
  523. QETH_CARD_TEXT(card, 2, "L2Setmac");
  524. rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
  525. IPA_CMD_SETVMAC));
  526. if (rc == 0) {
  527. card->info.mac_bits |= QETH_LAYER2_MAC_REGISTERED;
  528. memcpy(card->dev->dev_addr, mac, OSA_ADDR_LEN);
  529. dev_info(&card->gdev->dev,
  530. "MAC address %pM successfully registered on device %s\n",
  531. card->dev->dev_addr, card->dev->name);
  532. } else {
  533. card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
  534. switch (rc) {
  535. case -EEXIST:
  536. dev_warn(&card->gdev->dev,
  537. "MAC address %pM already exists\n", mac);
  538. break;
  539. case -EPERM:
  540. dev_warn(&card->gdev->dev,
  541. "MAC address %pM is not authorized\n", mac);
  542. break;
  543. }
  544. }
  545. return rc;
  546. }
  547. static int qeth_l2_send_delmac(struct qeth_card *card, __u8 *mac)
  548. {
  549. int rc;
  550. QETH_CARD_TEXT(card, 2, "L2Delmac");
  551. if (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))
  552. return 0;
  553. rc = qeth_setdel_makerc(card, qeth_l2_send_setdelmac(card, mac,
  554. IPA_CMD_DELVMAC));
  555. if (rc == 0)
  556. card->info.mac_bits &= ~QETH_LAYER2_MAC_REGISTERED;
  557. return rc;
  558. }
  559. static int qeth_l2_request_initial_mac(struct qeth_card *card)
  560. {
  561. int rc = 0;
  562. char vendor_pre[] = {0x02, 0x00, 0x00};
  563. QETH_DBF_TEXT(SETUP, 2, "doL2init");
  564. QETH_DBF_TEXT_(SETUP, 2, "doL2%s", CARD_BUS_ID(card));
  565. if (qeth_is_supported(card, IPA_SETADAPTERPARMS)) {
  566. rc = qeth_query_setadapterparms(card);
  567. if (rc) {
  568. QETH_DBF_MESSAGE(2, "could not query adapter "
  569. "parameters on device %s: x%x\n",
  570. CARD_BUS_ID(card), rc);
  571. }
  572. }
  573. if (card->info.type == QETH_CARD_TYPE_IQD ||
  574. card->info.type == QETH_CARD_TYPE_OSM ||
  575. card->info.type == QETH_CARD_TYPE_OSX ||
  576. card->info.guestlan) {
  577. rc = qeth_setadpparms_change_macaddr(card);
  578. if (rc) {
  579. QETH_DBF_MESSAGE(2, "couldn't get MAC address on "
  580. "device %s: x%x\n", CARD_BUS_ID(card), rc);
  581. QETH_DBF_TEXT_(SETUP, 2, "1err%04x", rc);
  582. return rc;
  583. }
  584. QETH_DBF_HEX(SETUP, 2, card->dev->dev_addr, OSA_ADDR_LEN);
  585. } else {
  586. eth_random_addr(card->dev->dev_addr);
  587. memcpy(card->dev->dev_addr, vendor_pre, 3);
  588. }
  589. return 0;
  590. }
  591. static int qeth_l2_set_mac_address(struct net_device *dev, void *p)
  592. {
  593. struct sockaddr *addr = p;
  594. struct qeth_card *card = dev->ml_priv;
  595. int rc = 0;
  596. QETH_CARD_TEXT(card, 3, "setmac");
  597. if (qeth_l2_verify_dev(dev) != QETH_REAL_CARD) {
  598. QETH_CARD_TEXT(card, 3, "setmcINV");
  599. return -EOPNOTSUPP;
  600. }
  601. if (card->info.type == QETH_CARD_TYPE_OSN ||
  602. card->info.type == QETH_CARD_TYPE_OSM ||
  603. card->info.type == QETH_CARD_TYPE_OSX) {
  604. QETH_CARD_TEXT(card, 3, "setmcTYP");
  605. return -EOPNOTSUPP;
  606. }
  607. QETH_CARD_HEX(card, 3, addr->sa_data, OSA_ADDR_LEN);
  608. if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
  609. QETH_CARD_TEXT(card, 3, "setmcREC");
  610. return -ERESTARTSYS;
  611. }
  612. rc = qeth_l2_send_delmac(card, &card->dev->dev_addr[0]);
  613. if (!rc || (rc == -ENOENT))
  614. rc = qeth_l2_send_setmac(card, addr->sa_data);
  615. return rc ? -EINVAL : 0;
  616. }
  617. static void qeth_l2_set_multicast_list(struct net_device *dev)
  618. {
  619. struct qeth_card *card = dev->ml_priv;
  620. struct netdev_hw_addr *ha;
  621. if (card->info.type == QETH_CARD_TYPE_OSN)
  622. return ;
  623. QETH_CARD_TEXT(card, 3, "setmulti");
  624. if (qeth_threads_running(card, QETH_RECOVER_THREAD) &&
  625. (card->state != CARD_STATE_UP))
  626. return;
  627. qeth_l2_del_all_mc(card, 1);
  628. spin_lock_bh(&card->mclock);
  629. netdev_for_each_mc_addr(ha, dev)
  630. qeth_l2_add_mc(card, ha->addr, 0);
  631. netdev_for_each_uc_addr(ha, dev)
  632. qeth_l2_add_mc(card, ha->addr, 1);
  633. spin_unlock_bh(&card->mclock);
  634. if (!qeth_adp_supported(card, IPA_SETADP_SET_PROMISC_MODE))
  635. return;
  636. qeth_setadp_promisc_mode(card);
  637. }
  638. static int qeth_l2_hard_start_xmit(struct sk_buff *skb, struct net_device *dev)
  639. {
  640. int rc;
  641. struct qeth_hdr *hdr = NULL;
  642. int elements = 0;
  643. struct qeth_card *card = dev->ml_priv;
  644. struct sk_buff *new_skb = skb;
  645. int cast_type = qeth_l2_get_cast_type(card, skb);
  646. struct qeth_qdio_out_q *queue;
  647. int tx_bytes = skb->len;
  648. int data_offset = -1;
  649. int elements_needed = 0;
  650. int hd_len = 0;
  651. if (card->qdio.do_prio_queueing || (cast_type &&
  652. card->info.is_multicast_different))
  653. queue = card->qdio.out_qs[qeth_get_priority_queue(card, skb,
  654. qeth_get_ip_version(skb), cast_type)];
  655. else
  656. queue = card->qdio.out_qs[card->qdio.default_out_queue];
  657. if ((card->state != CARD_STATE_UP) || !card->lan_online) {
  658. card->stats.tx_carrier_errors++;
  659. goto tx_drop;
  660. }
  661. if ((card->info.type == QETH_CARD_TYPE_OSN) &&
  662. (skb->protocol == htons(ETH_P_IPV6)))
  663. goto tx_drop;
  664. if (card->options.performance_stats) {
  665. card->perf_stats.outbound_cnt++;
  666. card->perf_stats.outbound_start_time = qeth_get_micros();
  667. }
  668. netif_stop_queue(dev);
  669. if (card->info.type == QETH_CARD_TYPE_OSN)
  670. hdr = (struct qeth_hdr *)skb->data;
  671. else {
  672. if (card->info.type == QETH_CARD_TYPE_IQD) {
  673. new_skb = skb;
  674. data_offset = ETH_HLEN;
  675. hd_len = ETH_HLEN;
  676. hdr = kmem_cache_alloc(qeth_core_header_cache,
  677. GFP_ATOMIC);
  678. if (!hdr)
  679. goto tx_drop;
  680. elements_needed++;
  681. skb_reset_mac_header(new_skb);
  682. qeth_l2_fill_header(card, hdr, new_skb, cast_type);
  683. hdr->hdr.l2.pkt_length = new_skb->len;
  684. memcpy(((char *)hdr) + sizeof(struct qeth_hdr),
  685. skb_mac_header(new_skb), ETH_HLEN);
  686. } else {
  687. /* create a clone with writeable headroom */
  688. new_skb = skb_realloc_headroom(skb,
  689. sizeof(struct qeth_hdr));
  690. if (!new_skb)
  691. goto tx_drop;
  692. hdr = (struct qeth_hdr *)skb_push(new_skb,
  693. sizeof(struct qeth_hdr));
  694. skb_set_mac_header(new_skb, sizeof(struct qeth_hdr));
  695. qeth_l2_fill_header(card, hdr, new_skb, cast_type);
  696. }
  697. }
  698. elements = qeth_get_elements_no(card, new_skb, elements_needed);
  699. if (!elements) {
  700. if (data_offset >= 0)
  701. kmem_cache_free(qeth_core_header_cache, hdr);
  702. goto tx_drop;
  703. }
  704. if (card->info.type != QETH_CARD_TYPE_IQD) {
  705. if (qeth_hdr_chk_and_bounce(new_skb, &hdr,
  706. sizeof(struct qeth_hdr_layer2)))
  707. goto tx_drop;
  708. rc = qeth_do_send_packet(card, queue, new_skb, hdr,
  709. elements);
  710. } else
  711. rc = qeth_do_send_packet_fast(card, queue, new_skb, hdr,
  712. elements, data_offset, hd_len);
  713. if (!rc) {
  714. card->stats.tx_packets++;
  715. card->stats.tx_bytes += tx_bytes;
  716. if (new_skb != skb)
  717. dev_kfree_skb_any(skb);
  718. rc = NETDEV_TX_OK;
  719. } else {
  720. if (data_offset >= 0)
  721. kmem_cache_free(qeth_core_header_cache, hdr);
  722. if (rc == -EBUSY) {
  723. if (new_skb != skb)
  724. dev_kfree_skb_any(new_skb);
  725. return NETDEV_TX_BUSY;
  726. } else
  727. goto tx_drop;
  728. }
  729. netif_wake_queue(dev);
  730. if (card->options.performance_stats)
  731. card->perf_stats.outbound_time += qeth_get_micros() -
  732. card->perf_stats.outbound_start_time;
  733. return rc;
  734. tx_drop:
  735. card->stats.tx_dropped++;
  736. card->stats.tx_errors++;
  737. if ((new_skb != skb) && new_skb)
  738. dev_kfree_skb_any(new_skb);
  739. dev_kfree_skb_any(skb);
  740. netif_wake_queue(dev);
  741. return NETDEV_TX_OK;
  742. }
  743. static int __qeth_l2_open(struct net_device *dev)
  744. {
  745. struct qeth_card *card = dev->ml_priv;
  746. int rc = 0;
  747. QETH_CARD_TEXT(card, 4, "qethopen");
  748. if (card->state == CARD_STATE_UP)
  749. return rc;
  750. if (card->state != CARD_STATE_SOFTSETUP)
  751. return -ENODEV;
  752. if ((card->info.type != QETH_CARD_TYPE_OSN) &&
  753. (!(card->info.mac_bits & QETH_LAYER2_MAC_REGISTERED))) {
  754. QETH_CARD_TEXT(card, 4, "nomacadr");
  755. return -EPERM;
  756. }
  757. card->data.state = CH_STATE_UP;
  758. card->state = CARD_STATE_UP;
  759. netif_start_queue(dev);
  760. if (qdio_stop_irq(card->data.ccwdev, 0) >= 0) {
  761. napi_enable(&card->napi);
  762. napi_schedule(&card->napi);
  763. } else
  764. rc = -EIO;
  765. return rc;
  766. }
  767. static int qeth_l2_open(struct net_device *dev)
  768. {
  769. struct qeth_card *card = dev->ml_priv;
  770. QETH_CARD_TEXT(card, 5, "qethope_");
  771. if (qeth_wait_for_threads(card, QETH_RECOVER_THREAD)) {
  772. QETH_CARD_TEXT(card, 3, "openREC");
  773. return -ERESTARTSYS;
  774. }
  775. return __qeth_l2_open(dev);
  776. }
  777. static int qeth_l2_stop(struct net_device *dev)
  778. {
  779. struct qeth_card *card = dev->ml_priv;
  780. QETH_CARD_TEXT(card, 4, "qethstop");
  781. netif_tx_disable(dev);
  782. if (card->state == CARD_STATE_UP) {
  783. card->state = CARD_STATE_SOFTSETUP;
  784. napi_disable(&card->napi);
  785. }
  786. return 0;
  787. }
  788. static int qeth_l2_probe_device(struct ccwgroup_device *gdev)
  789. {
  790. struct qeth_card *card = dev_get_drvdata(&gdev->dev);
  791. qeth_l2_create_device_attributes(&gdev->dev);
  792. INIT_LIST_HEAD(&card->vid_list);
  793. INIT_LIST_HEAD(&card->mc_list);
  794. card->options.layer2 = 1;
  795. card->info.hwtrap = 0;
  796. return 0;
  797. }
  798. static void qeth_l2_remove_device(struct ccwgroup_device *cgdev)
  799. {
  800. struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
  801. qeth_l2_remove_device_attributes(&cgdev->dev);
  802. qeth_set_allowed_threads(card, 0, 1);
  803. wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
  804. if (cgdev->state == CCWGROUP_ONLINE)
  805. qeth_l2_set_offline(cgdev);
  806. if (card->dev) {
  807. unregister_netdev(card->dev);
  808. card->dev = NULL;
  809. }
  810. return;
  811. }
  812. static const struct ethtool_ops qeth_l2_ethtool_ops = {
  813. .get_link = ethtool_op_get_link,
  814. .get_strings = qeth_core_get_strings,
  815. .get_ethtool_stats = qeth_core_get_ethtool_stats,
  816. .get_sset_count = qeth_core_get_sset_count,
  817. .get_drvinfo = qeth_core_get_drvinfo,
  818. .get_settings = qeth_core_ethtool_get_settings,
  819. };
  820. static const struct ethtool_ops qeth_l2_osn_ops = {
  821. .get_strings = qeth_core_get_strings,
  822. .get_ethtool_stats = qeth_core_get_ethtool_stats,
  823. .get_sset_count = qeth_core_get_sset_count,
  824. .get_drvinfo = qeth_core_get_drvinfo,
  825. };
  826. static const struct net_device_ops qeth_l2_netdev_ops = {
  827. .ndo_open = qeth_l2_open,
  828. .ndo_stop = qeth_l2_stop,
  829. .ndo_get_stats = qeth_get_stats,
  830. .ndo_start_xmit = qeth_l2_hard_start_xmit,
  831. .ndo_validate_addr = eth_validate_addr,
  832. .ndo_set_rx_mode = qeth_l2_set_multicast_list,
  833. .ndo_do_ioctl = qeth_l2_do_ioctl,
  834. .ndo_set_mac_address = qeth_l2_set_mac_address,
  835. .ndo_change_mtu = qeth_change_mtu,
  836. .ndo_vlan_rx_add_vid = qeth_l2_vlan_rx_add_vid,
  837. .ndo_vlan_rx_kill_vid = qeth_l2_vlan_rx_kill_vid,
  838. .ndo_tx_timeout = qeth_tx_timeout,
  839. };
  840. static int qeth_l2_setup_netdev(struct qeth_card *card)
  841. {
  842. switch (card->info.type) {
  843. case QETH_CARD_TYPE_IQD:
  844. card->dev = alloc_netdev(0, "hsi%d", NET_NAME_UNKNOWN,
  845. ether_setup);
  846. break;
  847. case QETH_CARD_TYPE_OSN:
  848. card->dev = alloc_netdev(0, "osn%d", NET_NAME_UNKNOWN,
  849. ether_setup);
  850. card->dev->flags |= IFF_NOARP;
  851. break;
  852. default:
  853. card->dev = alloc_etherdev(0);
  854. }
  855. if (!card->dev)
  856. return -ENODEV;
  857. card->dev->ml_priv = card;
  858. card->dev->watchdog_timeo = QETH_TX_TIMEOUT;
  859. card->dev->mtu = card->info.initial_mtu;
  860. card->dev->netdev_ops = &qeth_l2_netdev_ops;
  861. card->dev->ethtool_ops =
  862. (card->info.type != QETH_CARD_TYPE_OSN) ?
  863. &qeth_l2_ethtool_ops : &qeth_l2_osn_ops;
  864. card->dev->features |= NETIF_F_HW_VLAN_CTAG_FILTER;
  865. card->info.broadcast_capable = 1;
  866. qeth_l2_request_initial_mac(card);
  867. SET_NETDEV_DEV(card->dev, &card->gdev->dev);
  868. netif_napi_add(card->dev, &card->napi, qeth_l2_poll, QETH_NAPI_WEIGHT);
  869. return register_netdev(card->dev);
  870. }
  871. static int __qeth_l2_set_online(struct ccwgroup_device *gdev, int recovery_mode)
  872. {
  873. struct qeth_card *card = dev_get_drvdata(&gdev->dev);
  874. int rc = 0;
  875. enum qeth_card_states recover_flag;
  876. mutex_lock(&card->discipline_mutex);
  877. mutex_lock(&card->conf_mutex);
  878. QETH_DBF_TEXT(SETUP, 2, "setonlin");
  879. QETH_DBF_HEX(SETUP, 2, &card, sizeof(void *));
  880. recover_flag = card->state;
  881. rc = qeth_core_hardsetup_card(card);
  882. if (rc) {
  883. QETH_DBF_TEXT_(SETUP, 2, "2err%04x", rc);
  884. rc = -ENODEV;
  885. goto out_remove;
  886. }
  887. qeth_bridgeport_query_support(card);
  888. if (card->options.sbp.supported_funcs)
  889. dev_info(&card->gdev->dev,
  890. "The device represents a HiperSockets Bridge Capable Port\n");
  891. qeth_trace_features(card);
  892. if (!card->dev && qeth_l2_setup_netdev(card)) {
  893. rc = -ENODEV;
  894. goto out_remove;
  895. }
  896. if (card->info.type != QETH_CARD_TYPE_OSN)
  897. qeth_l2_send_setmac(card, &card->dev->dev_addr[0]);
  898. if (qeth_is_diagass_supported(card, QETH_DIAGS_CMD_TRAP)) {
  899. if (card->info.hwtrap &&
  900. qeth_hw_trap(card, QETH_DIAGS_TRAP_ARM))
  901. card->info.hwtrap = 0;
  902. } else
  903. card->info.hwtrap = 0;
  904. qeth_l2_setup_bridgeport_attrs(card);
  905. card->state = CARD_STATE_HARDSETUP;
  906. memset(&card->rx, 0, sizeof(struct qeth_rx));
  907. qeth_print_status_message(card);
  908. /* softsetup */
  909. QETH_DBF_TEXT(SETUP, 2, "softsetp");
  910. rc = qeth_send_startlan(card);
  911. if (rc) {
  912. QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
  913. if (rc == 0xe080) {
  914. dev_warn(&card->gdev->dev,
  915. "The LAN is offline\n");
  916. card->lan_online = 0;
  917. goto contin;
  918. }
  919. rc = -ENODEV;
  920. goto out_remove;
  921. } else
  922. card->lan_online = 1;
  923. contin:
  924. if ((card->info.type == QETH_CARD_TYPE_OSD) ||
  925. (card->info.type == QETH_CARD_TYPE_OSX)) {
  926. /* configure isolation level */
  927. rc = qeth_set_access_ctrl_online(card, 0);
  928. if (rc) {
  929. rc = -ENODEV;
  930. goto out_remove;
  931. }
  932. }
  933. if (card->info.type != QETH_CARD_TYPE_OSN &&
  934. card->info.type != QETH_CARD_TYPE_OSM)
  935. qeth_l2_process_vlans(card);
  936. netif_tx_disable(card->dev);
  937. rc = qeth_init_qdio_queues(card);
  938. if (rc) {
  939. QETH_DBF_TEXT_(SETUP, 2, "6err%d", rc);
  940. rc = -ENODEV;
  941. goto out_remove;
  942. }
  943. card->state = CARD_STATE_SOFTSETUP;
  944. if (card->lan_online)
  945. netif_carrier_on(card->dev);
  946. else
  947. netif_carrier_off(card->dev);
  948. qeth_set_allowed_threads(card, 0xffffffff, 0);
  949. if (recover_flag == CARD_STATE_RECOVER) {
  950. if (recovery_mode &&
  951. card->info.type != QETH_CARD_TYPE_OSN) {
  952. __qeth_l2_open(card->dev);
  953. } else {
  954. rtnl_lock();
  955. dev_open(card->dev);
  956. rtnl_unlock();
  957. }
  958. /* this also sets saved unicast addresses */
  959. qeth_l2_set_multicast_list(card->dev);
  960. }
  961. /* let user_space know that device is online */
  962. kobject_uevent(&gdev->dev.kobj, KOBJ_CHANGE);
  963. mutex_unlock(&card->conf_mutex);
  964. mutex_unlock(&card->discipline_mutex);
  965. return 0;
  966. out_remove:
  967. qeth_l2_stop_card(card, 0);
  968. ccw_device_set_offline(CARD_DDEV(card));
  969. ccw_device_set_offline(CARD_WDEV(card));
  970. ccw_device_set_offline(CARD_RDEV(card));
  971. qdio_free(CARD_DDEV(card));
  972. if (recover_flag == CARD_STATE_RECOVER)
  973. card->state = CARD_STATE_RECOVER;
  974. else
  975. card->state = CARD_STATE_DOWN;
  976. mutex_unlock(&card->conf_mutex);
  977. mutex_unlock(&card->discipline_mutex);
  978. return rc;
  979. }
  980. static int qeth_l2_set_online(struct ccwgroup_device *gdev)
  981. {
  982. return __qeth_l2_set_online(gdev, 0);
  983. }
  984. static int __qeth_l2_set_offline(struct ccwgroup_device *cgdev,
  985. int recovery_mode)
  986. {
  987. struct qeth_card *card = dev_get_drvdata(&cgdev->dev);
  988. int rc = 0, rc2 = 0, rc3 = 0;
  989. enum qeth_card_states recover_flag;
  990. mutex_lock(&card->discipline_mutex);
  991. mutex_lock(&card->conf_mutex);
  992. QETH_DBF_TEXT(SETUP, 3, "setoffl");
  993. QETH_DBF_HEX(SETUP, 3, &card, sizeof(void *));
  994. if (card->dev && netif_carrier_ok(card->dev))
  995. netif_carrier_off(card->dev);
  996. recover_flag = card->state;
  997. if ((!recovery_mode && card->info.hwtrap) || card->info.hwtrap == 2) {
  998. qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
  999. card->info.hwtrap = 1;
  1000. }
  1001. qeth_l2_stop_card(card, recovery_mode);
  1002. rc = ccw_device_set_offline(CARD_DDEV(card));
  1003. rc2 = ccw_device_set_offline(CARD_WDEV(card));
  1004. rc3 = ccw_device_set_offline(CARD_RDEV(card));
  1005. if (!rc)
  1006. rc = (rc2) ? rc2 : rc3;
  1007. if (rc)
  1008. QETH_DBF_TEXT_(SETUP, 2, "1err%d", rc);
  1009. qdio_free(CARD_DDEV(card));
  1010. if (recover_flag == CARD_STATE_UP)
  1011. card->state = CARD_STATE_RECOVER;
  1012. /* let user_space know that device is offline */
  1013. kobject_uevent(&cgdev->dev.kobj, KOBJ_CHANGE);
  1014. mutex_unlock(&card->conf_mutex);
  1015. mutex_unlock(&card->discipline_mutex);
  1016. return 0;
  1017. }
  1018. static int qeth_l2_set_offline(struct ccwgroup_device *cgdev)
  1019. {
  1020. return __qeth_l2_set_offline(cgdev, 0);
  1021. }
  1022. static int qeth_l2_recover(void *ptr)
  1023. {
  1024. struct qeth_card *card;
  1025. int rc = 0;
  1026. card = (struct qeth_card *) ptr;
  1027. QETH_CARD_TEXT(card, 2, "recover1");
  1028. if (!qeth_do_run_thread(card, QETH_RECOVER_THREAD))
  1029. return 0;
  1030. QETH_CARD_TEXT(card, 2, "recover2");
  1031. dev_warn(&card->gdev->dev,
  1032. "A recovery process has been started for the device\n");
  1033. qeth_set_recovery_task(card);
  1034. __qeth_l2_set_offline(card->gdev, 1);
  1035. rc = __qeth_l2_set_online(card->gdev, 1);
  1036. if (!rc)
  1037. dev_info(&card->gdev->dev,
  1038. "Device successfully recovered!\n");
  1039. else {
  1040. qeth_close_dev(card);
  1041. dev_warn(&card->gdev->dev, "The qeth device driver "
  1042. "failed to recover an error on the device\n");
  1043. }
  1044. qeth_clear_recovery_task(card);
  1045. qeth_clear_thread_start_bit(card, QETH_RECOVER_THREAD);
  1046. qeth_clear_thread_running_bit(card, QETH_RECOVER_THREAD);
  1047. return 0;
  1048. }
  1049. static int __init qeth_l2_init(void)
  1050. {
  1051. pr_info("register layer 2 discipline\n");
  1052. return 0;
  1053. }
  1054. static void __exit qeth_l2_exit(void)
  1055. {
  1056. pr_info("unregister layer 2 discipline\n");
  1057. }
  1058. static void qeth_l2_shutdown(struct ccwgroup_device *gdev)
  1059. {
  1060. struct qeth_card *card = dev_get_drvdata(&gdev->dev);
  1061. qeth_set_allowed_threads(card, 0, 1);
  1062. if ((gdev->state == CCWGROUP_ONLINE) && card->info.hwtrap)
  1063. qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
  1064. qeth_qdio_clear_card(card, 0);
  1065. qeth_clear_qdio_buffers(card);
  1066. qdio_free(CARD_DDEV(card));
  1067. }
  1068. static int qeth_l2_pm_suspend(struct ccwgroup_device *gdev)
  1069. {
  1070. struct qeth_card *card = dev_get_drvdata(&gdev->dev);
  1071. if (card->dev)
  1072. netif_device_detach(card->dev);
  1073. qeth_set_allowed_threads(card, 0, 1);
  1074. wait_event(card->wait_q, qeth_threads_running(card, 0xffffffff) == 0);
  1075. if (gdev->state == CCWGROUP_OFFLINE)
  1076. return 0;
  1077. if (card->state == CARD_STATE_UP) {
  1078. if (card->info.hwtrap)
  1079. qeth_hw_trap(card, QETH_DIAGS_TRAP_DISARM);
  1080. __qeth_l2_set_offline(card->gdev, 1);
  1081. } else
  1082. __qeth_l2_set_offline(card->gdev, 0);
  1083. return 0;
  1084. }
  1085. static int qeth_l2_pm_resume(struct ccwgroup_device *gdev)
  1086. {
  1087. struct qeth_card *card = dev_get_drvdata(&gdev->dev);
  1088. int rc = 0;
  1089. if (gdev->state == CCWGROUP_OFFLINE)
  1090. goto out;
  1091. if (card->state == CARD_STATE_RECOVER) {
  1092. rc = __qeth_l2_set_online(card->gdev, 1);
  1093. if (rc) {
  1094. rtnl_lock();
  1095. dev_close(card->dev);
  1096. rtnl_unlock();
  1097. }
  1098. } else
  1099. rc = __qeth_l2_set_online(card->gdev, 0);
  1100. out:
  1101. qeth_set_allowed_threads(card, 0xffffffff, 0);
  1102. if (card->dev)
  1103. netif_device_attach(card->dev);
  1104. if (rc)
  1105. dev_warn(&card->gdev->dev, "The qeth device driver "
  1106. "failed to recover an error on the device\n");
  1107. return rc;
  1108. }
  1109. /* Returns zero if the command is successfully "consumed" */
  1110. static int qeth_l2_control_event(struct qeth_card *card,
  1111. struct qeth_ipa_cmd *cmd)
  1112. {
  1113. switch (cmd->hdr.command) {
  1114. case IPA_CMD_SETBRIDGEPORT:
  1115. if (cmd->data.sbp.hdr.command_code ==
  1116. IPA_SBP_BRIDGE_PORT_STATE_CHANGE) {
  1117. qeth_bridge_state_change(card, cmd);
  1118. return 0;
  1119. } else
  1120. return 1;
  1121. case IPA_CMD_ADDRESS_CHANGE_NOTIF:
  1122. qeth_bridge_host_event(card, cmd);
  1123. return 0;
  1124. default:
  1125. return 1;
  1126. }
  1127. }
  1128. struct qeth_discipline qeth_l2_discipline = {
  1129. .start_poll = qeth_qdio_start_poll,
  1130. .input_handler = (qdio_handler_t *) qeth_qdio_input_handler,
  1131. .output_handler = (qdio_handler_t *) qeth_qdio_output_handler,
  1132. .recover = qeth_l2_recover,
  1133. .setup = qeth_l2_probe_device,
  1134. .remove = qeth_l2_remove_device,
  1135. .set_online = qeth_l2_set_online,
  1136. .set_offline = qeth_l2_set_offline,
  1137. .shutdown = qeth_l2_shutdown,
  1138. .freeze = qeth_l2_pm_suspend,
  1139. .thaw = qeth_l2_pm_resume,
  1140. .restore = qeth_l2_pm_resume,
  1141. .control_event_handler = qeth_l2_control_event,
  1142. };
  1143. EXPORT_SYMBOL_GPL(qeth_l2_discipline);
  1144. static int qeth_osn_send_control_data(struct qeth_card *card, int len,
  1145. struct qeth_cmd_buffer *iob)
  1146. {
  1147. unsigned long flags;
  1148. int rc = 0;
  1149. QETH_CARD_TEXT(card, 5, "osndctrd");
  1150. wait_event(card->wait_q,
  1151. atomic_cmpxchg(&card->write.irq_pending, 0, 1) == 0);
  1152. qeth_prepare_control_data(card, len, iob);
  1153. QETH_CARD_TEXT(card, 6, "osnoirqp");
  1154. spin_lock_irqsave(get_ccwdev_lock(card->write.ccwdev), flags);
  1155. rc = ccw_device_start(card->write.ccwdev, &card->write.ccw,
  1156. (addr_t) iob, 0, 0);
  1157. spin_unlock_irqrestore(get_ccwdev_lock(card->write.ccwdev), flags);
  1158. if (rc) {
  1159. QETH_DBF_MESSAGE(2, "qeth_osn_send_control_data: "
  1160. "ccw_device_start rc = %i\n", rc);
  1161. QETH_CARD_TEXT_(card, 2, " err%d", rc);
  1162. qeth_release_buffer(iob->channel, iob);
  1163. atomic_set(&card->write.irq_pending, 0);
  1164. wake_up(&card->wait_q);
  1165. }
  1166. return rc;
  1167. }
  1168. static int qeth_osn_send_ipa_cmd(struct qeth_card *card,
  1169. struct qeth_cmd_buffer *iob, int data_len)
  1170. {
  1171. u16 s1, s2;
  1172. QETH_CARD_TEXT(card, 4, "osndipa");
  1173. qeth_prepare_ipa_cmd(card, iob, QETH_PROT_OSN2);
  1174. s1 = (u16)(IPA_PDU_HEADER_SIZE + data_len);
  1175. s2 = (u16)data_len;
  1176. memcpy(QETH_IPA_PDU_LEN_TOTAL(iob->data), &s1, 2);
  1177. memcpy(QETH_IPA_PDU_LEN_PDU1(iob->data), &s2, 2);
  1178. memcpy(QETH_IPA_PDU_LEN_PDU2(iob->data), &s2, 2);
  1179. memcpy(QETH_IPA_PDU_LEN_PDU3(iob->data), &s2, 2);
  1180. return qeth_osn_send_control_data(card, s1, iob);
  1181. }
  1182. int qeth_osn_assist(struct net_device *dev, void *data, int data_len)
  1183. {
  1184. struct qeth_cmd_buffer *iob;
  1185. struct qeth_card *card;
  1186. int rc;
  1187. if (!dev)
  1188. return -ENODEV;
  1189. card = dev->ml_priv;
  1190. if (!card)
  1191. return -ENODEV;
  1192. QETH_CARD_TEXT(card, 2, "osnsdmc");
  1193. if (!qeth_card_hw_is_reachable(card))
  1194. return -ENODEV;
  1195. iob = qeth_wait_for_buffer(&card->write);
  1196. memcpy(iob->data+IPA_PDU_HEADER_SIZE, data, data_len);
  1197. rc = qeth_osn_send_ipa_cmd(card, iob, data_len);
  1198. return rc;
  1199. }
  1200. EXPORT_SYMBOL(qeth_osn_assist);
  1201. int qeth_osn_register(unsigned char *read_dev_no, struct net_device **dev,
  1202. int (*assist_cb)(struct net_device *, void *),
  1203. int (*data_cb)(struct sk_buff *))
  1204. {
  1205. struct qeth_card *card;
  1206. *dev = qeth_l2_netdev_by_devno(read_dev_no);
  1207. if (*dev == NULL)
  1208. return -ENODEV;
  1209. card = (*dev)->ml_priv;
  1210. if (!card)
  1211. return -ENODEV;
  1212. QETH_CARD_TEXT(card, 2, "osnreg");
  1213. if ((assist_cb == NULL) || (data_cb == NULL))
  1214. return -EINVAL;
  1215. card->osn_info.assist_cb = assist_cb;
  1216. card->osn_info.data_cb = data_cb;
  1217. return 0;
  1218. }
  1219. EXPORT_SYMBOL(qeth_osn_register);
  1220. void qeth_osn_deregister(struct net_device *dev)
  1221. {
  1222. struct qeth_card *card;
  1223. if (!dev)
  1224. return;
  1225. card = dev->ml_priv;
  1226. if (!card)
  1227. return;
  1228. QETH_CARD_TEXT(card, 2, "osndereg");
  1229. card->osn_info.assist_cb = NULL;
  1230. card->osn_info.data_cb = NULL;
  1231. return;
  1232. }
  1233. EXPORT_SYMBOL(qeth_osn_deregister);
  1234. /* SETBRIDGEPORT support, async notifications */
  1235. enum qeth_an_event_type {anev_reg_unreg, anev_abort, anev_reset};
  1236. /**
  1237. * qeth_bridge_emit_host_event() - bridgeport address change notification
  1238. * @card: qeth_card structure pointer, for udev events.
  1239. * @evtype: "normal" register/unregister, or abort, or reset. For abort
  1240. * and reset token and addr_lnid are unused and may be NULL.
  1241. * @code: event bitmask: high order bit 0x80 value 1 means removal of an
  1242. * object, 0 - addition of an object.
  1243. * 0x01 - VLAN, 0x02 - MAC, 0x03 - VLAN and MAC.
  1244. * @token: "network token" structure identifying physical address of the port.
  1245. * @addr_lnid: pointer to structure with MAC address and VLAN ID.
  1246. *
  1247. * This function is called when registrations and deregistrations are
  1248. * reported by the hardware, and also when notifications are enabled -
  1249. * for all currently registered addresses.
  1250. */
  1251. static void qeth_bridge_emit_host_event(struct qeth_card *card,
  1252. enum qeth_an_event_type evtype,
  1253. u8 code, struct net_if_token *token, struct mac_addr_lnid *addr_lnid)
  1254. {
  1255. char str[7][32];
  1256. char *env[8];
  1257. int i = 0;
  1258. switch (evtype) {
  1259. case anev_reg_unreg:
  1260. snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=%s",
  1261. (code & IPA_ADDR_CHANGE_CODE_REMOVAL)
  1262. ? "deregister" : "register");
  1263. env[i] = str[i]; i++;
  1264. if (code & IPA_ADDR_CHANGE_CODE_VLANID) {
  1265. snprintf(str[i], sizeof(str[i]), "VLAN=%d",
  1266. addr_lnid->lnid);
  1267. env[i] = str[i]; i++;
  1268. }
  1269. if (code & IPA_ADDR_CHANGE_CODE_MACADDR) {
  1270. snprintf(str[i], sizeof(str[i]), "MAC=%pM6",
  1271. &addr_lnid->mac);
  1272. env[i] = str[i]; i++;
  1273. }
  1274. snprintf(str[i], sizeof(str[i]), "NTOK_BUSID=%x.%x.%04x",
  1275. token->cssid, token->ssid, token->devnum);
  1276. env[i] = str[i]; i++;
  1277. snprintf(str[i], sizeof(str[i]), "NTOK_IID=%02x", token->iid);
  1278. env[i] = str[i]; i++;
  1279. snprintf(str[i], sizeof(str[i]), "NTOK_CHPID=%02x",
  1280. token->chpid);
  1281. env[i] = str[i]; i++;
  1282. snprintf(str[i], sizeof(str[i]), "NTOK_CHID=%04x", token->chid);
  1283. env[i] = str[i]; i++;
  1284. break;
  1285. case anev_abort:
  1286. snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=abort");
  1287. env[i] = str[i]; i++;
  1288. break;
  1289. case anev_reset:
  1290. snprintf(str[i], sizeof(str[i]), "BRIDGEDHOST=reset");
  1291. env[i] = str[i]; i++;
  1292. break;
  1293. }
  1294. env[i] = NULL;
  1295. kobject_uevent_env(&card->gdev->dev.kobj, KOBJ_CHANGE, env);
  1296. }
  1297. struct qeth_bridge_state_data {
  1298. struct work_struct worker;
  1299. struct qeth_card *card;
  1300. struct qeth_sbp_state_change qports;
  1301. };
  1302. static void qeth_bridge_state_change_worker(struct work_struct *work)
  1303. {
  1304. struct qeth_bridge_state_data *data =
  1305. container_of(work, struct qeth_bridge_state_data, worker);
  1306. /* We are only interested in the first entry - local port */
  1307. struct qeth_sbp_port_entry *entry = &data->qports.entry[0];
  1308. char env_locrem[32];
  1309. char env_role[32];
  1310. char env_state[32];
  1311. char *env[] = {
  1312. env_locrem,
  1313. env_role,
  1314. env_state,
  1315. NULL
  1316. };
  1317. /* Role should not change by itself, but if it did, */
  1318. /* information from the hardware is authoritative. */
  1319. mutex_lock(&data->card->conf_mutex);
  1320. data->card->options.sbp.role = entry->role;
  1321. mutex_unlock(&data->card->conf_mutex);
  1322. snprintf(env_locrem, sizeof(env_locrem), "BRIDGEPORT=statechange");
  1323. snprintf(env_role, sizeof(env_role), "ROLE=%s",
  1324. (entry->role == QETH_SBP_ROLE_NONE) ? "none" :
  1325. (entry->role == QETH_SBP_ROLE_PRIMARY) ? "primary" :
  1326. (entry->role == QETH_SBP_ROLE_SECONDARY) ? "secondary" :
  1327. "<INVALID>");
  1328. snprintf(env_state, sizeof(env_state), "STATE=%s",
  1329. (entry->state == QETH_SBP_STATE_INACTIVE) ? "inactive" :
  1330. (entry->state == QETH_SBP_STATE_STANDBY) ? "standby" :
  1331. (entry->state == QETH_SBP_STATE_ACTIVE) ? "active" :
  1332. "<INVALID>");
  1333. kobject_uevent_env(&data->card->gdev->dev.kobj,
  1334. KOBJ_CHANGE, env);
  1335. kfree(data);
  1336. }
  1337. static void qeth_bridge_state_change(struct qeth_card *card,
  1338. struct qeth_ipa_cmd *cmd)
  1339. {
  1340. struct qeth_sbp_state_change *qports =
  1341. &cmd->data.sbp.data.state_change;
  1342. struct qeth_bridge_state_data *data;
  1343. int extrasize;
  1344. QETH_CARD_TEXT(card, 2, "brstchng");
  1345. if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
  1346. QETH_CARD_TEXT_(card, 2, "BPsz%04x", qports->entry_length);
  1347. return;
  1348. }
  1349. extrasize = sizeof(struct qeth_sbp_port_entry) * qports->num_entries;
  1350. data = kzalloc(sizeof(struct qeth_bridge_state_data) + extrasize,
  1351. GFP_ATOMIC);
  1352. if (!data) {
  1353. QETH_CARD_TEXT(card, 2, "BPSalloc");
  1354. return;
  1355. }
  1356. INIT_WORK(&data->worker, qeth_bridge_state_change_worker);
  1357. data->card = card;
  1358. memcpy(&data->qports, qports,
  1359. sizeof(struct qeth_sbp_state_change) + extrasize);
  1360. queue_work(qeth_wq, &data->worker);
  1361. }
  1362. struct qeth_bridge_host_data {
  1363. struct work_struct worker;
  1364. struct qeth_card *card;
  1365. struct qeth_ipacmd_addr_change hostevs;
  1366. };
  1367. static void qeth_bridge_host_event_worker(struct work_struct *work)
  1368. {
  1369. struct qeth_bridge_host_data *data =
  1370. container_of(work, struct qeth_bridge_host_data, worker);
  1371. int i;
  1372. if (data->hostevs.lost_event_mask) {
  1373. dev_info(&data->card->gdev->dev,
  1374. "Address notification from the HiperSockets Bridge Port stopped %s (%s)\n",
  1375. data->card->dev->name,
  1376. (data->hostevs.lost_event_mask == 0x01)
  1377. ? "Overflow"
  1378. : (data->hostevs.lost_event_mask == 0x02)
  1379. ? "Bridge port state change"
  1380. : "Unknown reason");
  1381. mutex_lock(&data->card->conf_mutex);
  1382. data->card->options.sbp.hostnotification = 0;
  1383. mutex_unlock(&data->card->conf_mutex);
  1384. qeth_bridge_emit_host_event(data->card, anev_abort,
  1385. 0, NULL, NULL);
  1386. } else
  1387. for (i = 0; i < data->hostevs.num_entries; i++) {
  1388. struct qeth_ipacmd_addr_change_entry *entry =
  1389. &data->hostevs.entry[i];
  1390. qeth_bridge_emit_host_event(data->card,
  1391. anev_reg_unreg,
  1392. entry->change_code,
  1393. &entry->token, &entry->addr_lnid);
  1394. }
  1395. kfree(data);
  1396. }
  1397. static void qeth_bridge_host_event(struct qeth_card *card,
  1398. struct qeth_ipa_cmd *cmd)
  1399. {
  1400. struct qeth_ipacmd_addr_change *hostevs =
  1401. &cmd->data.addrchange;
  1402. struct qeth_bridge_host_data *data;
  1403. int extrasize;
  1404. QETH_CARD_TEXT(card, 2, "brhostev");
  1405. if (cmd->hdr.return_code != 0x0000) {
  1406. if (cmd->hdr.return_code == 0x0010) {
  1407. if (hostevs->lost_event_mask == 0x00)
  1408. hostevs->lost_event_mask = 0xff;
  1409. } else {
  1410. QETH_CARD_TEXT_(card, 2, "BPHe%04x",
  1411. cmd->hdr.return_code);
  1412. return;
  1413. }
  1414. }
  1415. extrasize = sizeof(struct qeth_ipacmd_addr_change_entry) *
  1416. hostevs->num_entries;
  1417. data = kzalloc(sizeof(struct qeth_bridge_host_data) + extrasize,
  1418. GFP_ATOMIC);
  1419. if (!data) {
  1420. QETH_CARD_TEXT(card, 2, "BPHalloc");
  1421. return;
  1422. }
  1423. INIT_WORK(&data->worker, qeth_bridge_host_event_worker);
  1424. data->card = card;
  1425. memcpy(&data->hostevs, hostevs,
  1426. sizeof(struct qeth_ipacmd_addr_change) + extrasize);
  1427. queue_work(qeth_wq, &data->worker);
  1428. }
  1429. /* SETBRIDGEPORT support; sending commands */
  1430. struct _qeth_sbp_cbctl {
  1431. u16 ipa_rc;
  1432. u16 cmd_rc;
  1433. union {
  1434. u32 supported;
  1435. struct {
  1436. enum qeth_sbp_roles *role;
  1437. enum qeth_sbp_states *state;
  1438. } qports;
  1439. } data;
  1440. };
  1441. /**
  1442. * qeth_bridgeport_makerc() - derive "traditional" error from hardware codes.
  1443. * @card: qeth_card structure pointer, for debug messages.
  1444. * @cbctl: state structure with hardware return codes.
  1445. * @setcmd: IPA command code
  1446. *
  1447. * Returns negative errno-compatible error indication or 0 on success.
  1448. */
  1449. static int qeth_bridgeport_makerc(struct qeth_card *card,
  1450. struct _qeth_sbp_cbctl *cbctl, enum qeth_ipa_sbp_cmd setcmd)
  1451. {
  1452. int rc;
  1453. switch (cbctl->ipa_rc) {
  1454. case IPA_RC_SUCCESS:
  1455. switch (cbctl->cmd_rc) {
  1456. case 0x0000:
  1457. rc = 0;
  1458. break;
  1459. case 0x0004:
  1460. rc = -ENOSYS;
  1461. break;
  1462. case 0x000C: /* Not configured as bridge Port */
  1463. rc = -ENODEV; /* maybe not the best code here? */
  1464. dev_err(&card->gdev->dev,
  1465. "The HiperSockets device is not configured as a Bridge Port\n");
  1466. break;
  1467. case 0x0014: /* Another device is Primary */
  1468. switch (setcmd) {
  1469. case IPA_SBP_SET_PRIMARY_BRIDGE_PORT:
  1470. rc = -EEXIST;
  1471. dev_err(&card->gdev->dev,
  1472. "The HiperSockets LAN already has a primary Bridge Port\n");
  1473. break;
  1474. case IPA_SBP_SET_SECONDARY_BRIDGE_PORT:
  1475. rc = -EBUSY;
  1476. dev_err(&card->gdev->dev,
  1477. "The HiperSockets device is already a primary Bridge Port\n");
  1478. break;
  1479. default:
  1480. rc = -EIO;
  1481. }
  1482. break;
  1483. case 0x0018: /* This device is currently Secondary */
  1484. rc = -EBUSY;
  1485. dev_err(&card->gdev->dev,
  1486. "The HiperSockets device is already a secondary Bridge Port\n");
  1487. break;
  1488. case 0x001C: /* Limit for Secondary devices reached */
  1489. rc = -EEXIST;
  1490. dev_err(&card->gdev->dev,
  1491. "The HiperSockets LAN cannot have more secondary Bridge Ports\n");
  1492. break;
  1493. case 0x0024: /* This device is currently Primary */
  1494. rc = -EBUSY;
  1495. dev_err(&card->gdev->dev,
  1496. "The HiperSockets device is already a primary Bridge Port\n");
  1497. break;
  1498. case 0x0020: /* Not authorized by zManager */
  1499. rc = -EACCES;
  1500. dev_err(&card->gdev->dev,
  1501. "The HiperSockets device is not authorized to be a Bridge Port\n");
  1502. break;
  1503. default:
  1504. rc = -EIO;
  1505. }
  1506. break;
  1507. case IPA_RC_NOTSUPP:
  1508. rc = -ENOSYS;
  1509. break;
  1510. case IPA_RC_UNSUPPORTED_COMMAND:
  1511. rc = -ENOSYS;
  1512. break;
  1513. default:
  1514. rc = -EIO;
  1515. }
  1516. if (rc) {
  1517. QETH_CARD_TEXT_(card, 2, "SBPi%04x", cbctl->ipa_rc);
  1518. QETH_CARD_TEXT_(card, 2, "SBPc%04x", cbctl->cmd_rc);
  1519. }
  1520. return rc;
  1521. }
  1522. static int qeth_bridgeport_query_support_cb(struct qeth_card *card,
  1523. struct qeth_reply *reply, unsigned long data)
  1524. {
  1525. struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
  1526. struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
  1527. QETH_CARD_TEXT(card, 2, "brqsupcb");
  1528. cbctl->ipa_rc = cmd->hdr.return_code;
  1529. cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
  1530. if ((cbctl->ipa_rc == 0) && (cbctl->cmd_rc == 0)) {
  1531. cbctl->data.supported =
  1532. cmd->data.sbp.data.query_cmds_supp.supported_cmds;
  1533. } else {
  1534. cbctl->data.supported = 0;
  1535. }
  1536. return 0;
  1537. }
  1538. /**
  1539. * qeth_bridgeport_query_support() - store bitmask of supported subfunctions.
  1540. * @card: qeth_card structure pointer.
  1541. *
  1542. * Sets bitmask of supported setbridgeport subfunctions in the qeth_card
  1543. * strucutre: card->options.sbp.supported_funcs.
  1544. */
  1545. static void qeth_bridgeport_query_support(struct qeth_card *card)
  1546. {
  1547. struct qeth_cmd_buffer *iob;
  1548. struct qeth_ipa_cmd *cmd;
  1549. struct _qeth_sbp_cbctl cbctl;
  1550. QETH_CARD_TEXT(card, 2, "brqsuppo");
  1551. iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
  1552. if (!iob)
  1553. return;
  1554. cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
  1555. cmd->data.sbp.hdr.cmdlength =
  1556. sizeof(struct qeth_ipacmd_sbp_hdr) +
  1557. sizeof(struct qeth_sbp_query_cmds_supp);
  1558. cmd->data.sbp.hdr.command_code =
  1559. IPA_SBP_QUERY_COMMANDS_SUPPORTED;
  1560. cmd->data.sbp.hdr.used_total = 1;
  1561. cmd->data.sbp.hdr.seq_no = 1;
  1562. if (qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_support_cb,
  1563. (void *)&cbctl) ||
  1564. qeth_bridgeport_makerc(card, &cbctl,
  1565. IPA_SBP_QUERY_COMMANDS_SUPPORTED)) {
  1566. /* non-zero makerc signifies failure, and produce messages */
  1567. card->options.sbp.role = QETH_SBP_ROLE_NONE;
  1568. return;
  1569. }
  1570. card->options.sbp.supported_funcs = cbctl.data.supported;
  1571. }
  1572. static int qeth_bridgeport_query_ports_cb(struct qeth_card *card,
  1573. struct qeth_reply *reply, unsigned long data)
  1574. {
  1575. struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *) data;
  1576. struct qeth_sbp_query_ports *qports = &cmd->data.sbp.data.query_ports;
  1577. struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
  1578. QETH_CARD_TEXT(card, 2, "brqprtcb");
  1579. cbctl->ipa_rc = cmd->hdr.return_code;
  1580. cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
  1581. if ((cbctl->ipa_rc != 0) || (cbctl->cmd_rc != 0))
  1582. return 0;
  1583. if (qports->entry_length != sizeof(struct qeth_sbp_port_entry)) {
  1584. cbctl->cmd_rc = 0xffff;
  1585. QETH_CARD_TEXT_(card, 2, "SBPs%04x", qports->entry_length);
  1586. return 0;
  1587. }
  1588. /* first entry contains the state of the local port */
  1589. if (qports->num_entries > 0) {
  1590. if (cbctl->data.qports.role)
  1591. *cbctl->data.qports.role = qports->entry[0].role;
  1592. if (cbctl->data.qports.state)
  1593. *cbctl->data.qports.state = qports->entry[0].state;
  1594. }
  1595. return 0;
  1596. }
  1597. /**
  1598. * qeth_bridgeport_query_ports() - query local bridgeport status.
  1599. * @card: qeth_card structure pointer.
  1600. * @role: Role of the port: 0-none, 1-primary, 2-secondary.
  1601. * @state: State of the port: 0-inactive, 1-standby, 2-active.
  1602. *
  1603. * Returns negative errno-compatible error indication or 0 on success.
  1604. *
  1605. * 'role' and 'state' are not updated in case of hardware operation failure.
  1606. */
  1607. int qeth_bridgeport_query_ports(struct qeth_card *card,
  1608. enum qeth_sbp_roles *role, enum qeth_sbp_states *state)
  1609. {
  1610. int rc = 0;
  1611. struct qeth_cmd_buffer *iob;
  1612. struct qeth_ipa_cmd *cmd;
  1613. struct _qeth_sbp_cbctl cbctl = {
  1614. .data = {
  1615. .qports = {
  1616. .role = role,
  1617. .state = state,
  1618. },
  1619. },
  1620. };
  1621. QETH_CARD_TEXT(card, 2, "brqports");
  1622. if (!(card->options.sbp.supported_funcs & IPA_SBP_QUERY_BRIDGE_PORTS))
  1623. return -EOPNOTSUPP;
  1624. iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
  1625. if (!iob)
  1626. return -ENOMEM;
  1627. cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
  1628. cmd->data.sbp.hdr.cmdlength =
  1629. sizeof(struct qeth_ipacmd_sbp_hdr);
  1630. cmd->data.sbp.hdr.command_code =
  1631. IPA_SBP_QUERY_BRIDGE_PORTS;
  1632. cmd->data.sbp.hdr.used_total = 1;
  1633. cmd->data.sbp.hdr.seq_no = 1;
  1634. rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_query_ports_cb,
  1635. (void *)&cbctl);
  1636. if (rc)
  1637. return rc;
  1638. rc = qeth_bridgeport_makerc(card, &cbctl, IPA_SBP_QUERY_BRIDGE_PORTS);
  1639. return rc;
  1640. }
  1641. EXPORT_SYMBOL_GPL(qeth_bridgeport_query_ports);
  1642. static int qeth_bridgeport_set_cb(struct qeth_card *card,
  1643. struct qeth_reply *reply, unsigned long data)
  1644. {
  1645. struct qeth_ipa_cmd *cmd = (struct qeth_ipa_cmd *)data;
  1646. struct _qeth_sbp_cbctl *cbctl = (struct _qeth_sbp_cbctl *)reply->param;
  1647. QETH_CARD_TEXT(card, 2, "brsetrcb");
  1648. cbctl->ipa_rc = cmd->hdr.return_code;
  1649. cbctl->cmd_rc = cmd->data.sbp.hdr.return_code;
  1650. return 0;
  1651. }
  1652. /**
  1653. * qeth_bridgeport_setrole() - Assign primary role to the port.
  1654. * @card: qeth_card structure pointer.
  1655. * @role: Role to assign.
  1656. *
  1657. * Returns negative errno-compatible error indication or 0 on success.
  1658. */
  1659. int qeth_bridgeport_setrole(struct qeth_card *card, enum qeth_sbp_roles role)
  1660. {
  1661. int rc = 0;
  1662. int cmdlength;
  1663. struct qeth_cmd_buffer *iob;
  1664. struct qeth_ipa_cmd *cmd;
  1665. struct _qeth_sbp_cbctl cbctl;
  1666. enum qeth_ipa_sbp_cmd setcmd;
  1667. QETH_CARD_TEXT(card, 2, "brsetrol");
  1668. switch (role) {
  1669. case QETH_SBP_ROLE_NONE:
  1670. setcmd = IPA_SBP_RESET_BRIDGE_PORT_ROLE;
  1671. cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
  1672. sizeof(struct qeth_sbp_reset_role);
  1673. break;
  1674. case QETH_SBP_ROLE_PRIMARY:
  1675. setcmd = IPA_SBP_SET_PRIMARY_BRIDGE_PORT;
  1676. cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
  1677. sizeof(struct qeth_sbp_set_primary);
  1678. break;
  1679. case QETH_SBP_ROLE_SECONDARY:
  1680. setcmd = IPA_SBP_SET_SECONDARY_BRIDGE_PORT;
  1681. cmdlength = sizeof(struct qeth_ipacmd_sbp_hdr) +
  1682. sizeof(struct qeth_sbp_set_secondary);
  1683. break;
  1684. default:
  1685. return -EINVAL;
  1686. }
  1687. if (!(card->options.sbp.supported_funcs & setcmd))
  1688. return -EOPNOTSUPP;
  1689. iob = qeth_get_ipacmd_buffer(card, IPA_CMD_SETBRIDGEPORT, 0);
  1690. if (!iob)
  1691. return -ENOMEM;
  1692. cmd = (struct qeth_ipa_cmd *)(iob->data+IPA_PDU_HEADER_SIZE);
  1693. cmd->data.sbp.hdr.cmdlength = cmdlength;
  1694. cmd->data.sbp.hdr.command_code = setcmd;
  1695. cmd->data.sbp.hdr.used_total = 1;
  1696. cmd->data.sbp.hdr.seq_no = 1;
  1697. rc = qeth_send_ipa_cmd(card, iob, qeth_bridgeport_set_cb,
  1698. (void *)&cbctl);
  1699. if (rc)
  1700. return rc;
  1701. rc = qeth_bridgeport_makerc(card, &cbctl, setcmd);
  1702. return rc;
  1703. }
  1704. /**
  1705. * qeth_anset_makerc() - derive "traditional" error from hardware codes.
  1706. * @card: qeth_card structure pointer, for debug messages.
  1707. *
  1708. * Returns negative errno-compatible error indication or 0 on success.
  1709. */
  1710. static int qeth_anset_makerc(struct qeth_card *card, int pnso_rc, u16 response)
  1711. {
  1712. int rc;
  1713. if (pnso_rc == 0)
  1714. switch (response) {
  1715. case 0x0001:
  1716. rc = 0;
  1717. break;
  1718. case 0x0004:
  1719. case 0x0100:
  1720. case 0x0106:
  1721. rc = -ENOSYS;
  1722. dev_err(&card->gdev->dev,
  1723. "Setting address notification failed\n");
  1724. break;
  1725. case 0x0107:
  1726. rc = -EAGAIN;
  1727. break;
  1728. default:
  1729. rc = -EIO;
  1730. }
  1731. else
  1732. rc = -EIO;
  1733. if (rc) {
  1734. QETH_CARD_TEXT_(card, 2, "SBPp%04x", pnso_rc);
  1735. QETH_CARD_TEXT_(card, 2, "SBPr%04x", response);
  1736. }
  1737. return rc;
  1738. }
  1739. static void qeth_bridgeport_an_set_cb(void *priv,
  1740. enum qdio_brinfo_entry_type type, void *entry)
  1741. {
  1742. struct qeth_card *card = (struct qeth_card *)priv;
  1743. struct qdio_brinfo_entry_l2 *l2entry;
  1744. u8 code;
  1745. if (type != l2_addr_lnid) {
  1746. WARN_ON_ONCE(1);
  1747. return;
  1748. }
  1749. l2entry = (struct qdio_brinfo_entry_l2 *)entry;
  1750. code = IPA_ADDR_CHANGE_CODE_MACADDR;
  1751. if (l2entry->addr_lnid.lnid)
  1752. code |= IPA_ADDR_CHANGE_CODE_VLANID;
  1753. qeth_bridge_emit_host_event(card, anev_reg_unreg, code,
  1754. (struct net_if_token *)&l2entry->nit,
  1755. (struct mac_addr_lnid *)&l2entry->addr_lnid);
  1756. }
  1757. /**
  1758. * qeth_bridgeport_an_set() - Enable or disable bridgeport address notification
  1759. * @card: qeth_card structure pointer.
  1760. * @enable: 0 - disable, non-zero - enable notifications
  1761. *
  1762. * Returns negative errno-compatible error indication or 0 on success.
  1763. *
  1764. * On enable, emits a series of address notifications udev events for all
  1765. * currently registered hosts.
  1766. */
  1767. int qeth_bridgeport_an_set(struct qeth_card *card, int enable)
  1768. {
  1769. int rc;
  1770. u16 response;
  1771. struct ccw_device *ddev;
  1772. struct subchannel_id schid;
  1773. if (!card)
  1774. return -EINVAL;
  1775. if (!card->options.sbp.supported_funcs)
  1776. return -EOPNOTSUPP;
  1777. ddev = CARD_DDEV(card);
  1778. ccw_device_get_schid(ddev, &schid);
  1779. if (enable) {
  1780. qeth_bridge_emit_host_event(card, anev_reset, 0, NULL, NULL);
  1781. rc = qdio_pnso_brinfo(schid, 1, &response,
  1782. qeth_bridgeport_an_set_cb, card);
  1783. } else
  1784. rc = qdio_pnso_brinfo(schid, 0, &response, NULL, NULL);
  1785. return qeth_anset_makerc(card, rc, response);
  1786. }
  1787. EXPORT_SYMBOL_GPL(qeth_bridgeport_an_set);
  1788. module_init(qeth_l2_init);
  1789. module_exit(qeth_l2_exit);
  1790. MODULE_AUTHOR("Frank Blaschka <frank.blaschka@de.ibm.com>");
  1791. MODULE_DESCRIPTION("qeth layer 2 discipline");
  1792. MODULE_LICENSE("GPL");