qeth_l2_main.c 53 KB

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