qeth_l3_sys.c 29 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167
  1. /*
  2. * drivers/s390/net/qeth_l3_sys.c
  3. *
  4. * Copyright IBM Corp. 2007
  5. * Author(s): Utz Bacher <utz.bacher@de.ibm.com>,
  6. * Frank Pavlic <fpavlic@de.ibm.com>,
  7. * Thomas Spatzier <tspat@de.ibm.com>,
  8. * Frank Blaschka <frank.blaschka@de.ibm.com>
  9. */
  10. #include <linux/slab.h>
  11. #include "qeth_l3.h"
  12. #define QETH_DEVICE_ATTR(_id, _name, _mode, _show, _store) \
  13. struct device_attribute dev_attr_##_id = __ATTR(_name, _mode, _show, _store)
  14. static const char *qeth_l3_get_checksum_str(struct qeth_card *card)
  15. {
  16. if (card->options.checksum_type == SW_CHECKSUMMING)
  17. return "sw";
  18. else if (card->options.checksum_type == HW_CHECKSUMMING)
  19. return "hw";
  20. else
  21. return "no";
  22. }
  23. static ssize_t qeth_l3_dev_route_show(struct qeth_card *card,
  24. struct qeth_routing_info *route, char *buf)
  25. {
  26. switch (route->type) {
  27. case PRIMARY_ROUTER:
  28. return sprintf(buf, "%s\n", "primary router");
  29. case SECONDARY_ROUTER:
  30. return sprintf(buf, "%s\n", "secondary router");
  31. case MULTICAST_ROUTER:
  32. if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
  33. return sprintf(buf, "%s\n", "multicast router+");
  34. else
  35. return sprintf(buf, "%s\n", "multicast router");
  36. case PRIMARY_CONNECTOR:
  37. if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
  38. return sprintf(buf, "%s\n", "primary connector+");
  39. else
  40. return sprintf(buf, "%s\n", "primary connector");
  41. case SECONDARY_CONNECTOR:
  42. if (card->info.broadcast_capable == QETH_BROADCAST_WITHOUT_ECHO)
  43. return sprintf(buf, "%s\n", "secondary connector+");
  44. else
  45. return sprintf(buf, "%s\n", "secondary connector");
  46. default:
  47. return sprintf(buf, "%s\n", "no");
  48. }
  49. }
  50. static ssize_t qeth_l3_dev_route4_show(struct device *dev,
  51. struct device_attribute *attr, char *buf)
  52. {
  53. struct qeth_card *card = dev_get_drvdata(dev);
  54. if (!card)
  55. return -EINVAL;
  56. return qeth_l3_dev_route_show(card, &card->options.route4, buf);
  57. }
  58. static ssize_t qeth_l3_dev_route_store(struct qeth_card *card,
  59. struct qeth_routing_info *route, enum qeth_prot_versions prot,
  60. const char *buf, size_t count)
  61. {
  62. enum qeth_routing_types old_route_type = route->type;
  63. char *tmp;
  64. int rc = 0;
  65. tmp = strsep((char **) &buf, "\n");
  66. mutex_lock(&card->conf_mutex);
  67. if (!strcmp(tmp, "no_router")) {
  68. route->type = NO_ROUTER;
  69. } else if (!strcmp(tmp, "primary_connector")) {
  70. route->type = PRIMARY_CONNECTOR;
  71. } else if (!strcmp(tmp, "secondary_connector")) {
  72. route->type = SECONDARY_CONNECTOR;
  73. } else if (!strcmp(tmp, "primary_router")) {
  74. route->type = PRIMARY_ROUTER;
  75. } else if (!strcmp(tmp, "secondary_router")) {
  76. route->type = SECONDARY_ROUTER;
  77. } else if (!strcmp(tmp, "multicast_router")) {
  78. route->type = MULTICAST_ROUTER;
  79. } else {
  80. rc = -EINVAL;
  81. goto out;
  82. }
  83. if (((card->state == CARD_STATE_SOFTSETUP) ||
  84. (card->state == CARD_STATE_UP)) &&
  85. (old_route_type != route->type)) {
  86. if (prot == QETH_PROT_IPV4)
  87. rc = qeth_l3_setrouting_v4(card);
  88. else if (prot == QETH_PROT_IPV6)
  89. rc = qeth_l3_setrouting_v6(card);
  90. }
  91. out:
  92. mutex_unlock(&card->conf_mutex);
  93. return rc ? rc : count;
  94. }
  95. static ssize_t qeth_l3_dev_route4_store(struct device *dev,
  96. struct device_attribute *attr, const char *buf, size_t count)
  97. {
  98. struct qeth_card *card = dev_get_drvdata(dev);
  99. if (!card)
  100. return -EINVAL;
  101. return qeth_l3_dev_route_store(card, &card->options.route4,
  102. QETH_PROT_IPV4, buf, count);
  103. }
  104. static DEVICE_ATTR(route4, 0644, qeth_l3_dev_route4_show,
  105. qeth_l3_dev_route4_store);
  106. static ssize_t qeth_l3_dev_route6_show(struct device *dev,
  107. struct device_attribute *attr, char *buf)
  108. {
  109. struct qeth_card *card = dev_get_drvdata(dev);
  110. if (!card)
  111. return -EINVAL;
  112. return qeth_l3_dev_route_show(card, &card->options.route6, buf);
  113. }
  114. static ssize_t qeth_l3_dev_route6_store(struct device *dev,
  115. struct device_attribute *attr, const char *buf, size_t count)
  116. {
  117. struct qeth_card *card = dev_get_drvdata(dev);
  118. if (!card)
  119. return -EINVAL;
  120. return qeth_l3_dev_route_store(card, &card->options.route6,
  121. QETH_PROT_IPV6, buf, count);
  122. }
  123. static DEVICE_ATTR(route6, 0644, qeth_l3_dev_route6_show,
  124. qeth_l3_dev_route6_store);
  125. static ssize_t qeth_l3_dev_fake_broadcast_show(struct device *dev,
  126. struct device_attribute *attr, char *buf)
  127. {
  128. struct qeth_card *card = dev_get_drvdata(dev);
  129. if (!card)
  130. return -EINVAL;
  131. return sprintf(buf, "%i\n", card->options.fake_broadcast? 1:0);
  132. }
  133. static ssize_t qeth_l3_dev_fake_broadcast_store(struct device *dev,
  134. struct device_attribute *attr, const char *buf, size_t count)
  135. {
  136. struct qeth_card *card = dev_get_drvdata(dev);
  137. char *tmp;
  138. int i, rc = 0;
  139. if (!card)
  140. return -EINVAL;
  141. mutex_lock(&card->conf_mutex);
  142. if ((card->state != CARD_STATE_DOWN) &&
  143. (card->state != CARD_STATE_RECOVER)) {
  144. rc = -EPERM;
  145. goto out;
  146. }
  147. i = simple_strtoul(buf, &tmp, 16);
  148. if ((i == 0) || (i == 1))
  149. card->options.fake_broadcast = i;
  150. else
  151. rc = -EINVAL;
  152. out:
  153. mutex_unlock(&card->conf_mutex);
  154. return rc ? rc : count;
  155. }
  156. static DEVICE_ATTR(fake_broadcast, 0644, qeth_l3_dev_fake_broadcast_show,
  157. qeth_l3_dev_fake_broadcast_store);
  158. static ssize_t qeth_l3_dev_broadcast_mode_show(struct device *dev,
  159. struct device_attribute *attr, char *buf)
  160. {
  161. struct qeth_card *card = dev_get_drvdata(dev);
  162. if (!card)
  163. return -EINVAL;
  164. if (!((card->info.link_type == QETH_LINK_TYPE_HSTR) ||
  165. (card->info.link_type == QETH_LINK_TYPE_LANE_TR)))
  166. return sprintf(buf, "n/a\n");
  167. return sprintf(buf, "%s\n", (card->options.broadcast_mode ==
  168. QETH_TR_BROADCAST_ALLRINGS)?
  169. "all rings":"local");
  170. }
  171. static ssize_t qeth_l3_dev_broadcast_mode_store(struct device *dev,
  172. struct device_attribute *attr, const char *buf, size_t count)
  173. {
  174. struct qeth_card *card = dev_get_drvdata(dev);
  175. char *tmp;
  176. int rc = 0;
  177. if (!card)
  178. return -EINVAL;
  179. mutex_lock(&card->conf_mutex);
  180. if ((card->state != CARD_STATE_DOWN) &&
  181. (card->state != CARD_STATE_RECOVER)) {
  182. rc = -EPERM;
  183. goto out;
  184. }
  185. if (!((card->info.link_type == QETH_LINK_TYPE_HSTR) ||
  186. (card->info.link_type == QETH_LINK_TYPE_LANE_TR))) {
  187. rc = -EINVAL;
  188. goto out;
  189. }
  190. tmp = strsep((char **) &buf, "\n");
  191. if (!strcmp(tmp, "local"))
  192. card->options.broadcast_mode = QETH_TR_BROADCAST_LOCAL;
  193. else if (!strcmp(tmp, "all_rings"))
  194. card->options.broadcast_mode = QETH_TR_BROADCAST_ALLRINGS;
  195. else
  196. rc = -EINVAL;
  197. out:
  198. mutex_unlock(&card->conf_mutex);
  199. return rc ? rc : count;
  200. }
  201. static DEVICE_ATTR(broadcast_mode, 0644, qeth_l3_dev_broadcast_mode_show,
  202. qeth_l3_dev_broadcast_mode_store);
  203. static ssize_t qeth_l3_dev_canonical_macaddr_show(struct device *dev,
  204. struct device_attribute *attr, char *buf)
  205. {
  206. struct qeth_card *card = dev_get_drvdata(dev);
  207. if (!card)
  208. return -EINVAL;
  209. if (!((card->info.link_type == QETH_LINK_TYPE_HSTR) ||
  210. (card->info.link_type == QETH_LINK_TYPE_LANE_TR)))
  211. return sprintf(buf, "n/a\n");
  212. return sprintf(buf, "%i\n", (card->options.macaddr_mode ==
  213. QETH_TR_MACADDR_CANONICAL)? 1:0);
  214. }
  215. static ssize_t qeth_l3_dev_canonical_macaddr_store(struct device *dev,
  216. struct device_attribute *attr, const char *buf, size_t count)
  217. {
  218. struct qeth_card *card = dev_get_drvdata(dev);
  219. char *tmp;
  220. int i, rc = 0;
  221. if (!card)
  222. return -EINVAL;
  223. mutex_lock(&card->conf_mutex);
  224. if ((card->state != CARD_STATE_DOWN) &&
  225. (card->state != CARD_STATE_RECOVER)) {
  226. rc = -EPERM;
  227. goto out;
  228. }
  229. if (!((card->info.link_type == QETH_LINK_TYPE_HSTR) ||
  230. (card->info.link_type == QETH_LINK_TYPE_LANE_TR))) {
  231. rc = -EINVAL;
  232. goto out;
  233. }
  234. i = simple_strtoul(buf, &tmp, 16);
  235. if ((i == 0) || (i == 1))
  236. card->options.macaddr_mode = i?
  237. QETH_TR_MACADDR_CANONICAL :
  238. QETH_TR_MACADDR_NONCANONICAL;
  239. else
  240. rc = -EINVAL;
  241. out:
  242. mutex_unlock(&card->conf_mutex);
  243. return rc ? rc : count;
  244. }
  245. static DEVICE_ATTR(canonical_macaddr, 0644, qeth_l3_dev_canonical_macaddr_show,
  246. qeth_l3_dev_canonical_macaddr_store);
  247. static ssize_t qeth_l3_dev_checksum_show(struct device *dev,
  248. struct device_attribute *attr, char *buf)
  249. {
  250. struct qeth_card *card = dev_get_drvdata(dev);
  251. if (!card)
  252. return -EINVAL;
  253. return sprintf(buf, "%s checksumming\n",
  254. qeth_l3_get_checksum_str(card));
  255. }
  256. static ssize_t qeth_l3_dev_checksum_store(struct device *dev,
  257. struct device_attribute *attr, const char *buf, size_t count)
  258. {
  259. struct qeth_card *card = dev_get_drvdata(dev);
  260. enum qeth_checksum_types csum_type;
  261. char *tmp;
  262. int rc = 0;
  263. if (!card)
  264. return -EINVAL;
  265. mutex_lock(&card->conf_mutex);
  266. tmp = strsep((char **) &buf, "\n");
  267. if (!strcmp(tmp, "sw_checksumming"))
  268. csum_type = SW_CHECKSUMMING;
  269. else if (!strcmp(tmp, "hw_checksumming"))
  270. csum_type = HW_CHECKSUMMING;
  271. else if (!strcmp(tmp, "no_checksumming"))
  272. csum_type = NO_CHECKSUMMING;
  273. else {
  274. rc = -EINVAL;
  275. goto out;
  276. }
  277. rc = qeth_l3_set_rx_csum(card, csum_type);
  278. out:
  279. mutex_unlock(&card->conf_mutex);
  280. return rc ? rc : count;
  281. }
  282. static DEVICE_ATTR(checksumming, 0644, qeth_l3_dev_checksum_show,
  283. qeth_l3_dev_checksum_store);
  284. static ssize_t qeth_l3_dev_sniffer_show(struct device *dev,
  285. struct device_attribute *attr, char *buf)
  286. {
  287. struct qeth_card *card = dev_get_drvdata(dev);
  288. if (!card)
  289. return -EINVAL;
  290. return sprintf(buf, "%i\n", card->options.sniffer ? 1 : 0);
  291. }
  292. static ssize_t qeth_l3_dev_sniffer_store(struct device *dev,
  293. struct device_attribute *attr, const char *buf, size_t count)
  294. {
  295. struct qeth_card *card = dev_get_drvdata(dev);
  296. int rc = 0;
  297. unsigned long i;
  298. if (!card)
  299. return -EINVAL;
  300. if (card->info.type != QETH_CARD_TYPE_IQD)
  301. return -EPERM;
  302. mutex_lock(&card->conf_mutex);
  303. if ((card->state != CARD_STATE_DOWN) &&
  304. (card->state != CARD_STATE_RECOVER)) {
  305. rc = -EPERM;
  306. goto out;
  307. }
  308. rc = strict_strtoul(buf, 16, &i);
  309. if (rc) {
  310. rc = -EINVAL;
  311. goto out;
  312. }
  313. switch (i) {
  314. case 0:
  315. card->options.sniffer = i;
  316. break;
  317. case 1:
  318. qdio_get_ssqd_desc(CARD_DDEV(card), &card->ssqd);
  319. if (card->ssqd.qdioac2 & QETH_SNIFF_AVAIL) {
  320. card->options.sniffer = i;
  321. if (card->qdio.init_pool.buf_count !=
  322. QETH_IN_BUF_COUNT_MAX)
  323. qeth_realloc_buffer_pool(card,
  324. QETH_IN_BUF_COUNT_MAX);
  325. break;
  326. } else
  327. rc = -EPERM;
  328. default: /* fall through */
  329. rc = -EINVAL;
  330. }
  331. out:
  332. mutex_unlock(&card->conf_mutex);
  333. return rc ? rc : count;
  334. }
  335. static DEVICE_ATTR(sniffer, 0644, qeth_l3_dev_sniffer_show,
  336. qeth_l3_dev_sniffer_store);
  337. static ssize_t qeth_l3_dev_large_send_show(struct device *dev,
  338. struct device_attribute *attr, char *buf)
  339. {
  340. struct qeth_card *card = dev_get_drvdata(dev);
  341. if (!card)
  342. return -EINVAL;
  343. switch (card->options.large_send) {
  344. case QETH_LARGE_SEND_NO:
  345. return sprintf(buf, "%s\n", "no");
  346. case QETH_LARGE_SEND_TSO:
  347. return sprintf(buf, "%s\n", "TSO");
  348. default:
  349. return sprintf(buf, "%s\n", "N/A");
  350. }
  351. }
  352. static ssize_t qeth_l3_dev_large_send_store(struct device *dev,
  353. struct device_attribute *attr, const char *buf, size_t count)
  354. {
  355. struct qeth_card *card = dev_get_drvdata(dev);
  356. enum qeth_large_send_types type;
  357. int rc = 0;
  358. char *tmp;
  359. if (!card)
  360. return -EINVAL;
  361. tmp = strsep((char **) &buf, "\n");
  362. if (!strcmp(tmp, "no"))
  363. type = QETH_LARGE_SEND_NO;
  364. else if (!strcmp(tmp, "TSO"))
  365. type = QETH_LARGE_SEND_TSO;
  366. else
  367. return -EINVAL;
  368. mutex_lock(&card->conf_mutex);
  369. if (card->options.large_send != type)
  370. rc = qeth_l3_set_large_send(card, type);
  371. mutex_unlock(&card->conf_mutex);
  372. return rc ? rc : count;
  373. }
  374. static DEVICE_ATTR(large_send, 0644, qeth_l3_dev_large_send_show,
  375. qeth_l3_dev_large_send_store);
  376. static struct attribute *qeth_l3_device_attrs[] = {
  377. &dev_attr_route4.attr,
  378. &dev_attr_route6.attr,
  379. &dev_attr_fake_broadcast.attr,
  380. &dev_attr_broadcast_mode.attr,
  381. &dev_attr_canonical_macaddr.attr,
  382. &dev_attr_checksumming.attr,
  383. &dev_attr_sniffer.attr,
  384. &dev_attr_large_send.attr,
  385. NULL,
  386. };
  387. static struct attribute_group qeth_l3_device_attr_group = {
  388. .attrs = qeth_l3_device_attrs,
  389. };
  390. static ssize_t qeth_l3_dev_ipato_enable_show(struct device *dev,
  391. struct device_attribute *attr, char *buf)
  392. {
  393. struct qeth_card *card = dev_get_drvdata(dev);
  394. if (!card)
  395. return -EINVAL;
  396. return sprintf(buf, "%i\n", card->ipato.enabled? 1:0);
  397. }
  398. static ssize_t qeth_l3_dev_ipato_enable_store(struct device *dev,
  399. struct device_attribute *attr, const char *buf, size_t count)
  400. {
  401. struct qeth_card *card = dev_get_drvdata(dev);
  402. struct qeth_ipaddr *tmpipa, *t;
  403. char *tmp;
  404. int rc = 0;
  405. if (!card)
  406. return -EINVAL;
  407. mutex_lock(&card->conf_mutex);
  408. if ((card->state != CARD_STATE_DOWN) &&
  409. (card->state != CARD_STATE_RECOVER)) {
  410. rc = -EPERM;
  411. goto out;
  412. }
  413. tmp = strsep((char **) &buf, "\n");
  414. if (!strcmp(tmp, "toggle")) {
  415. card->ipato.enabled = (card->ipato.enabled)? 0 : 1;
  416. } else if (!strcmp(tmp, "1")) {
  417. card->ipato.enabled = 1;
  418. list_for_each_entry_safe(tmpipa, t, card->ip_tbd_list, entry) {
  419. if ((tmpipa->type == QETH_IP_TYPE_NORMAL) &&
  420. qeth_l3_is_addr_covered_by_ipato(card, tmpipa))
  421. tmpipa->set_flags |=
  422. QETH_IPA_SETIP_TAKEOVER_FLAG;
  423. }
  424. } else if (!strcmp(tmp, "0")) {
  425. card->ipato.enabled = 0;
  426. list_for_each_entry_safe(tmpipa, t, card->ip_tbd_list, entry) {
  427. if (tmpipa->set_flags &
  428. QETH_IPA_SETIP_TAKEOVER_FLAG)
  429. tmpipa->set_flags &=
  430. ~QETH_IPA_SETIP_TAKEOVER_FLAG;
  431. }
  432. } else
  433. rc = -EINVAL;
  434. out:
  435. mutex_unlock(&card->conf_mutex);
  436. return rc ? rc : count;
  437. }
  438. static QETH_DEVICE_ATTR(ipato_enable, enable, 0644,
  439. qeth_l3_dev_ipato_enable_show,
  440. qeth_l3_dev_ipato_enable_store);
  441. static ssize_t qeth_l3_dev_ipato_invert4_show(struct device *dev,
  442. struct device_attribute *attr, char *buf)
  443. {
  444. struct qeth_card *card = dev_get_drvdata(dev);
  445. if (!card)
  446. return -EINVAL;
  447. return sprintf(buf, "%i\n", card->ipato.invert4? 1:0);
  448. }
  449. static ssize_t qeth_l3_dev_ipato_invert4_store(struct device *dev,
  450. struct device_attribute *attr,
  451. const char *buf, size_t count)
  452. {
  453. struct qeth_card *card = dev_get_drvdata(dev);
  454. char *tmp;
  455. int rc = 0;
  456. if (!card)
  457. return -EINVAL;
  458. mutex_lock(&card->conf_mutex);
  459. tmp = strsep((char **) &buf, "\n");
  460. if (!strcmp(tmp, "toggle")) {
  461. card->ipato.invert4 = (card->ipato.invert4)? 0 : 1;
  462. } else if (!strcmp(tmp, "1")) {
  463. card->ipato.invert4 = 1;
  464. } else if (!strcmp(tmp, "0")) {
  465. card->ipato.invert4 = 0;
  466. } else
  467. rc = -EINVAL;
  468. mutex_unlock(&card->conf_mutex);
  469. return rc ? rc : count;
  470. }
  471. static QETH_DEVICE_ATTR(ipato_invert4, invert4, 0644,
  472. qeth_l3_dev_ipato_invert4_show,
  473. qeth_l3_dev_ipato_invert4_store);
  474. static ssize_t qeth_l3_dev_ipato_add_show(char *buf, struct qeth_card *card,
  475. enum qeth_prot_versions proto)
  476. {
  477. struct qeth_ipato_entry *ipatoe;
  478. unsigned long flags;
  479. char addr_str[40];
  480. int entry_len; /* length of 1 entry string, differs between v4 and v6 */
  481. int i = 0;
  482. entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
  483. /* add strlen for "/<mask>\n" */
  484. entry_len += (proto == QETH_PROT_IPV4)? 5 : 6;
  485. spin_lock_irqsave(&card->ip_lock, flags);
  486. list_for_each_entry(ipatoe, &card->ipato.entries, entry) {
  487. if (ipatoe->proto != proto)
  488. continue;
  489. /* String must not be longer than PAGE_SIZE. So we check if
  490. * string length gets near PAGE_SIZE. Then we can savely display
  491. * the next IPv6 address (worst case, compared to IPv4) */
  492. if ((PAGE_SIZE - i) <= entry_len)
  493. break;
  494. qeth_l3_ipaddr_to_string(proto, ipatoe->addr, addr_str);
  495. i += snprintf(buf + i, PAGE_SIZE - i,
  496. "%s/%i\n", addr_str, ipatoe->mask_bits);
  497. }
  498. spin_unlock_irqrestore(&card->ip_lock, flags);
  499. i += snprintf(buf + i, PAGE_SIZE - i, "\n");
  500. return i;
  501. }
  502. static ssize_t qeth_l3_dev_ipato_add4_show(struct device *dev,
  503. struct device_attribute *attr, char *buf)
  504. {
  505. struct qeth_card *card = dev_get_drvdata(dev);
  506. if (!card)
  507. return -EINVAL;
  508. return qeth_l3_dev_ipato_add_show(buf, card, QETH_PROT_IPV4);
  509. }
  510. static int qeth_l3_parse_ipatoe(const char *buf, enum qeth_prot_versions proto,
  511. u8 *addr, int *mask_bits)
  512. {
  513. const char *start, *end;
  514. char *tmp;
  515. char buffer[40] = {0, };
  516. start = buf;
  517. /* get address string */
  518. end = strchr(start, '/');
  519. if (!end || (end - start >= 40)) {
  520. return -EINVAL;
  521. }
  522. strncpy(buffer, start, end - start);
  523. if (qeth_l3_string_to_ipaddr(buffer, proto, addr)) {
  524. return -EINVAL;
  525. }
  526. start = end + 1;
  527. *mask_bits = simple_strtoul(start, &tmp, 10);
  528. if (!strlen(start) ||
  529. (tmp == start) ||
  530. (*mask_bits > ((proto == QETH_PROT_IPV4) ? 32 : 128))) {
  531. return -EINVAL;
  532. }
  533. return 0;
  534. }
  535. static ssize_t qeth_l3_dev_ipato_add_store(const char *buf, size_t count,
  536. struct qeth_card *card, enum qeth_prot_versions proto)
  537. {
  538. struct qeth_ipato_entry *ipatoe;
  539. u8 addr[16];
  540. int mask_bits;
  541. int rc = 0;
  542. mutex_lock(&card->conf_mutex);
  543. rc = qeth_l3_parse_ipatoe(buf, proto, addr, &mask_bits);
  544. if (rc)
  545. goto out;
  546. ipatoe = kzalloc(sizeof(struct qeth_ipato_entry), GFP_KERNEL);
  547. if (!ipatoe) {
  548. rc = -ENOMEM;
  549. goto out;
  550. }
  551. ipatoe->proto = proto;
  552. memcpy(ipatoe->addr, addr, (proto == QETH_PROT_IPV4)? 4:16);
  553. ipatoe->mask_bits = mask_bits;
  554. rc = qeth_l3_add_ipato_entry(card, ipatoe);
  555. if (rc)
  556. kfree(ipatoe);
  557. out:
  558. mutex_unlock(&card->conf_mutex);
  559. return rc ? rc : count;
  560. }
  561. static ssize_t qeth_l3_dev_ipato_add4_store(struct device *dev,
  562. struct device_attribute *attr, const char *buf, size_t count)
  563. {
  564. struct qeth_card *card = dev_get_drvdata(dev);
  565. if (!card)
  566. return -EINVAL;
  567. return qeth_l3_dev_ipato_add_store(buf, count, card, QETH_PROT_IPV4);
  568. }
  569. static QETH_DEVICE_ATTR(ipato_add4, add4, 0644,
  570. qeth_l3_dev_ipato_add4_show,
  571. qeth_l3_dev_ipato_add4_store);
  572. static ssize_t qeth_l3_dev_ipato_del_store(const char *buf, size_t count,
  573. struct qeth_card *card, enum qeth_prot_versions proto)
  574. {
  575. u8 addr[16];
  576. int mask_bits;
  577. int rc = 0;
  578. mutex_lock(&card->conf_mutex);
  579. rc = qeth_l3_parse_ipatoe(buf, proto, addr, &mask_bits);
  580. if (!rc)
  581. qeth_l3_del_ipato_entry(card, proto, addr, mask_bits);
  582. mutex_unlock(&card->conf_mutex);
  583. return rc ? rc : count;
  584. }
  585. static ssize_t qeth_l3_dev_ipato_del4_store(struct device *dev,
  586. struct device_attribute *attr, const char *buf, size_t count)
  587. {
  588. struct qeth_card *card = dev_get_drvdata(dev);
  589. if (!card)
  590. return -EINVAL;
  591. return qeth_l3_dev_ipato_del_store(buf, count, card, QETH_PROT_IPV4);
  592. }
  593. static QETH_DEVICE_ATTR(ipato_del4, del4, 0200, NULL,
  594. qeth_l3_dev_ipato_del4_store);
  595. static ssize_t qeth_l3_dev_ipato_invert6_show(struct device *dev,
  596. struct device_attribute *attr, char *buf)
  597. {
  598. struct qeth_card *card = dev_get_drvdata(dev);
  599. if (!card)
  600. return -EINVAL;
  601. return sprintf(buf, "%i\n", card->ipato.invert6? 1:0);
  602. }
  603. static ssize_t qeth_l3_dev_ipato_invert6_store(struct device *dev,
  604. struct device_attribute *attr, const char *buf, size_t count)
  605. {
  606. struct qeth_card *card = dev_get_drvdata(dev);
  607. char *tmp;
  608. int rc = 0;
  609. if (!card)
  610. return -EINVAL;
  611. mutex_lock(&card->conf_mutex);
  612. tmp = strsep((char **) &buf, "\n");
  613. if (!strcmp(tmp, "toggle")) {
  614. card->ipato.invert6 = (card->ipato.invert6)? 0 : 1;
  615. } else if (!strcmp(tmp, "1")) {
  616. card->ipato.invert6 = 1;
  617. } else if (!strcmp(tmp, "0")) {
  618. card->ipato.invert6 = 0;
  619. } else
  620. rc = -EINVAL;
  621. mutex_unlock(&card->conf_mutex);
  622. return rc ? rc : count;
  623. }
  624. static QETH_DEVICE_ATTR(ipato_invert6, invert6, 0644,
  625. qeth_l3_dev_ipato_invert6_show,
  626. qeth_l3_dev_ipato_invert6_store);
  627. static ssize_t qeth_l3_dev_ipato_add6_show(struct device *dev,
  628. struct device_attribute *attr, char *buf)
  629. {
  630. struct qeth_card *card = dev_get_drvdata(dev);
  631. if (!card)
  632. return -EINVAL;
  633. return qeth_l3_dev_ipato_add_show(buf, card, QETH_PROT_IPV6);
  634. }
  635. static ssize_t qeth_l3_dev_ipato_add6_store(struct device *dev,
  636. struct device_attribute *attr, const char *buf, size_t count)
  637. {
  638. struct qeth_card *card = dev_get_drvdata(dev);
  639. if (!card)
  640. return -EINVAL;
  641. return qeth_l3_dev_ipato_add_store(buf, count, card, QETH_PROT_IPV6);
  642. }
  643. static QETH_DEVICE_ATTR(ipato_add6, add6, 0644,
  644. qeth_l3_dev_ipato_add6_show,
  645. qeth_l3_dev_ipato_add6_store);
  646. static ssize_t qeth_l3_dev_ipato_del6_store(struct device *dev,
  647. struct device_attribute *attr, const char *buf, size_t count)
  648. {
  649. struct qeth_card *card = dev_get_drvdata(dev);
  650. if (!card)
  651. return -EINVAL;
  652. return qeth_l3_dev_ipato_del_store(buf, count, card, QETH_PROT_IPV6);
  653. }
  654. static QETH_DEVICE_ATTR(ipato_del6, del6, 0200, NULL,
  655. qeth_l3_dev_ipato_del6_store);
  656. static struct attribute *qeth_ipato_device_attrs[] = {
  657. &dev_attr_ipato_enable.attr,
  658. &dev_attr_ipato_invert4.attr,
  659. &dev_attr_ipato_add4.attr,
  660. &dev_attr_ipato_del4.attr,
  661. &dev_attr_ipato_invert6.attr,
  662. &dev_attr_ipato_add6.attr,
  663. &dev_attr_ipato_del6.attr,
  664. NULL,
  665. };
  666. static struct attribute_group qeth_device_ipato_group = {
  667. .name = "ipa_takeover",
  668. .attrs = qeth_ipato_device_attrs,
  669. };
  670. static ssize_t qeth_l3_dev_vipa_add_show(char *buf, struct qeth_card *card,
  671. enum qeth_prot_versions proto)
  672. {
  673. struct qeth_ipaddr *ipaddr;
  674. char addr_str[40];
  675. int entry_len; /* length of 1 entry string, differs between v4 and v6 */
  676. unsigned long flags;
  677. int i = 0;
  678. entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
  679. entry_len += 2; /* \n + terminator */
  680. spin_lock_irqsave(&card->ip_lock, flags);
  681. list_for_each_entry(ipaddr, &card->ip_list, entry) {
  682. if (ipaddr->proto != proto)
  683. continue;
  684. if (ipaddr->type != QETH_IP_TYPE_VIPA)
  685. continue;
  686. /* String must not be longer than PAGE_SIZE. So we check if
  687. * string length gets near PAGE_SIZE. Then we can savely display
  688. * the next IPv6 address (worst case, compared to IPv4) */
  689. if ((PAGE_SIZE - i) <= entry_len)
  690. break;
  691. qeth_l3_ipaddr_to_string(proto, (const u8 *)&ipaddr->u,
  692. addr_str);
  693. i += snprintf(buf + i, PAGE_SIZE - i, "%s\n", addr_str);
  694. }
  695. spin_unlock_irqrestore(&card->ip_lock, flags);
  696. i += snprintf(buf + i, PAGE_SIZE - i, "\n");
  697. return i;
  698. }
  699. static ssize_t qeth_l3_dev_vipa_add4_show(struct device *dev,
  700. struct device_attribute *attr, char *buf)
  701. {
  702. struct qeth_card *card = dev_get_drvdata(dev);
  703. if (!card)
  704. return -EINVAL;
  705. return qeth_l3_dev_vipa_add_show(buf, card, QETH_PROT_IPV4);
  706. }
  707. static int qeth_l3_parse_vipae(const char *buf, enum qeth_prot_versions proto,
  708. u8 *addr)
  709. {
  710. if (qeth_l3_string_to_ipaddr(buf, proto, addr)) {
  711. return -EINVAL;
  712. }
  713. return 0;
  714. }
  715. static ssize_t qeth_l3_dev_vipa_add_store(const char *buf, size_t count,
  716. struct qeth_card *card, enum qeth_prot_versions proto)
  717. {
  718. u8 addr[16] = {0, };
  719. int rc;
  720. mutex_lock(&card->conf_mutex);
  721. rc = qeth_l3_parse_vipae(buf, proto, addr);
  722. if (!rc)
  723. rc = qeth_l3_add_vipa(card, proto, addr);
  724. mutex_unlock(&card->conf_mutex);
  725. return rc ? rc : count;
  726. }
  727. static ssize_t qeth_l3_dev_vipa_add4_store(struct device *dev,
  728. struct device_attribute *attr, const char *buf, size_t count)
  729. {
  730. struct qeth_card *card = dev_get_drvdata(dev);
  731. if (!card)
  732. return -EINVAL;
  733. return qeth_l3_dev_vipa_add_store(buf, count, card, QETH_PROT_IPV4);
  734. }
  735. static QETH_DEVICE_ATTR(vipa_add4, add4, 0644,
  736. qeth_l3_dev_vipa_add4_show,
  737. qeth_l3_dev_vipa_add4_store);
  738. static ssize_t qeth_l3_dev_vipa_del_store(const char *buf, size_t count,
  739. struct qeth_card *card, enum qeth_prot_versions proto)
  740. {
  741. u8 addr[16];
  742. int rc;
  743. mutex_lock(&card->conf_mutex);
  744. rc = qeth_l3_parse_vipae(buf, proto, addr);
  745. if (!rc)
  746. qeth_l3_del_vipa(card, proto, addr);
  747. mutex_unlock(&card->conf_mutex);
  748. return rc ? rc : count;
  749. }
  750. static ssize_t qeth_l3_dev_vipa_del4_store(struct device *dev,
  751. struct device_attribute *attr, const char *buf, size_t count)
  752. {
  753. struct qeth_card *card = dev_get_drvdata(dev);
  754. if (!card)
  755. return -EINVAL;
  756. return qeth_l3_dev_vipa_del_store(buf, count, card, QETH_PROT_IPV4);
  757. }
  758. static QETH_DEVICE_ATTR(vipa_del4, del4, 0200, NULL,
  759. qeth_l3_dev_vipa_del4_store);
  760. static ssize_t qeth_l3_dev_vipa_add6_show(struct device *dev,
  761. struct device_attribute *attr, char *buf)
  762. {
  763. struct qeth_card *card = dev_get_drvdata(dev);
  764. if (!card)
  765. return -EINVAL;
  766. return qeth_l3_dev_vipa_add_show(buf, card, QETH_PROT_IPV6);
  767. }
  768. static ssize_t qeth_l3_dev_vipa_add6_store(struct device *dev,
  769. struct device_attribute *attr, const char *buf, size_t count)
  770. {
  771. struct qeth_card *card = dev_get_drvdata(dev);
  772. if (!card)
  773. return -EINVAL;
  774. return qeth_l3_dev_vipa_add_store(buf, count, card, QETH_PROT_IPV6);
  775. }
  776. static QETH_DEVICE_ATTR(vipa_add6, add6, 0644,
  777. qeth_l3_dev_vipa_add6_show,
  778. qeth_l3_dev_vipa_add6_store);
  779. static ssize_t qeth_l3_dev_vipa_del6_store(struct device *dev,
  780. struct device_attribute *attr, const char *buf, size_t count)
  781. {
  782. struct qeth_card *card = dev_get_drvdata(dev);
  783. if (!card)
  784. return -EINVAL;
  785. return qeth_l3_dev_vipa_del_store(buf, count, card, QETH_PROT_IPV6);
  786. }
  787. static QETH_DEVICE_ATTR(vipa_del6, del6, 0200, NULL,
  788. qeth_l3_dev_vipa_del6_store);
  789. static struct attribute *qeth_vipa_device_attrs[] = {
  790. &dev_attr_vipa_add4.attr,
  791. &dev_attr_vipa_del4.attr,
  792. &dev_attr_vipa_add6.attr,
  793. &dev_attr_vipa_del6.attr,
  794. NULL,
  795. };
  796. static struct attribute_group qeth_device_vipa_group = {
  797. .name = "vipa",
  798. .attrs = qeth_vipa_device_attrs,
  799. };
  800. static ssize_t qeth_l3_dev_rxip_add_show(char *buf, struct qeth_card *card,
  801. enum qeth_prot_versions proto)
  802. {
  803. struct qeth_ipaddr *ipaddr;
  804. char addr_str[40];
  805. int entry_len; /* length of 1 entry string, differs between v4 and v6 */
  806. unsigned long flags;
  807. int i = 0;
  808. entry_len = (proto == QETH_PROT_IPV4)? 12 : 40;
  809. entry_len += 2; /* \n + terminator */
  810. spin_lock_irqsave(&card->ip_lock, flags);
  811. list_for_each_entry(ipaddr, &card->ip_list, entry) {
  812. if (ipaddr->proto != proto)
  813. continue;
  814. if (ipaddr->type != QETH_IP_TYPE_RXIP)
  815. continue;
  816. /* String must not be longer than PAGE_SIZE. So we check if
  817. * string length gets near PAGE_SIZE. Then we can savely display
  818. * the next IPv6 address (worst case, compared to IPv4) */
  819. if ((PAGE_SIZE - i) <= entry_len)
  820. break;
  821. qeth_l3_ipaddr_to_string(proto, (const u8 *)&ipaddr->u,
  822. addr_str);
  823. i += snprintf(buf + i, PAGE_SIZE - i, "%s\n", addr_str);
  824. }
  825. spin_unlock_irqrestore(&card->ip_lock, flags);
  826. i += snprintf(buf + i, PAGE_SIZE - i, "\n");
  827. return i;
  828. }
  829. static ssize_t qeth_l3_dev_rxip_add4_show(struct device *dev,
  830. struct device_attribute *attr, char *buf)
  831. {
  832. struct qeth_card *card = dev_get_drvdata(dev);
  833. if (!card)
  834. return -EINVAL;
  835. return qeth_l3_dev_rxip_add_show(buf, card, QETH_PROT_IPV4);
  836. }
  837. static int qeth_l3_parse_rxipe(const char *buf, enum qeth_prot_versions proto,
  838. u8 *addr)
  839. {
  840. if (qeth_l3_string_to_ipaddr(buf, proto, addr)) {
  841. return -EINVAL;
  842. }
  843. return 0;
  844. }
  845. static ssize_t qeth_l3_dev_rxip_add_store(const char *buf, size_t count,
  846. struct qeth_card *card, enum qeth_prot_versions proto)
  847. {
  848. u8 addr[16] = {0, };
  849. int rc;
  850. mutex_lock(&card->conf_mutex);
  851. rc = qeth_l3_parse_rxipe(buf, proto, addr);
  852. if (!rc)
  853. rc = qeth_l3_add_rxip(card, proto, addr);
  854. mutex_unlock(&card->conf_mutex);
  855. return rc ? rc : count;
  856. }
  857. static ssize_t qeth_l3_dev_rxip_add4_store(struct device *dev,
  858. struct device_attribute *attr, const char *buf, size_t count)
  859. {
  860. struct qeth_card *card = dev_get_drvdata(dev);
  861. if (!card)
  862. return -EINVAL;
  863. return qeth_l3_dev_rxip_add_store(buf, count, card, QETH_PROT_IPV4);
  864. }
  865. static QETH_DEVICE_ATTR(rxip_add4, add4, 0644,
  866. qeth_l3_dev_rxip_add4_show,
  867. qeth_l3_dev_rxip_add4_store);
  868. static ssize_t qeth_l3_dev_rxip_del_store(const char *buf, size_t count,
  869. struct qeth_card *card, enum qeth_prot_versions proto)
  870. {
  871. u8 addr[16];
  872. int rc;
  873. mutex_lock(&card->conf_mutex);
  874. rc = qeth_l3_parse_rxipe(buf, proto, addr);
  875. if (!rc)
  876. qeth_l3_del_rxip(card, proto, addr);
  877. mutex_unlock(&card->conf_mutex);
  878. return rc ? rc : count;
  879. }
  880. static ssize_t qeth_l3_dev_rxip_del4_store(struct device *dev,
  881. struct device_attribute *attr, const char *buf, size_t count)
  882. {
  883. struct qeth_card *card = dev_get_drvdata(dev);
  884. if (!card)
  885. return -EINVAL;
  886. return qeth_l3_dev_rxip_del_store(buf, count, card, QETH_PROT_IPV4);
  887. }
  888. static QETH_DEVICE_ATTR(rxip_del4, del4, 0200, NULL,
  889. qeth_l3_dev_rxip_del4_store);
  890. static ssize_t qeth_l3_dev_rxip_add6_show(struct device *dev,
  891. struct device_attribute *attr, char *buf)
  892. {
  893. struct qeth_card *card = dev_get_drvdata(dev);
  894. if (!card)
  895. return -EINVAL;
  896. return qeth_l3_dev_rxip_add_show(buf, card, QETH_PROT_IPV6);
  897. }
  898. static ssize_t qeth_l3_dev_rxip_add6_store(struct device *dev,
  899. struct device_attribute *attr, const char *buf, size_t count)
  900. {
  901. struct qeth_card *card = dev_get_drvdata(dev);
  902. if (!card)
  903. return -EINVAL;
  904. return qeth_l3_dev_rxip_add_store(buf, count, card, QETH_PROT_IPV6);
  905. }
  906. static QETH_DEVICE_ATTR(rxip_add6, add6, 0644,
  907. qeth_l3_dev_rxip_add6_show,
  908. qeth_l3_dev_rxip_add6_store);
  909. static ssize_t qeth_l3_dev_rxip_del6_store(struct device *dev,
  910. struct device_attribute *attr, const char *buf, size_t count)
  911. {
  912. struct qeth_card *card = dev_get_drvdata(dev);
  913. if (!card)
  914. return -EINVAL;
  915. return qeth_l3_dev_rxip_del_store(buf, count, card, QETH_PROT_IPV6);
  916. }
  917. static QETH_DEVICE_ATTR(rxip_del6, del6, 0200, NULL,
  918. qeth_l3_dev_rxip_del6_store);
  919. static struct attribute *qeth_rxip_device_attrs[] = {
  920. &dev_attr_rxip_add4.attr,
  921. &dev_attr_rxip_del4.attr,
  922. &dev_attr_rxip_add6.attr,
  923. &dev_attr_rxip_del6.attr,
  924. NULL,
  925. };
  926. static struct attribute_group qeth_device_rxip_group = {
  927. .name = "rxip",
  928. .attrs = qeth_rxip_device_attrs,
  929. };
  930. int qeth_l3_create_device_attributes(struct device *dev)
  931. {
  932. int ret;
  933. ret = sysfs_create_group(&dev->kobj, &qeth_l3_device_attr_group);
  934. if (ret)
  935. return ret;
  936. ret = sysfs_create_group(&dev->kobj, &qeth_device_ipato_group);
  937. if (ret) {
  938. sysfs_remove_group(&dev->kobj, &qeth_l3_device_attr_group);
  939. return ret;
  940. }
  941. ret = sysfs_create_group(&dev->kobj, &qeth_device_vipa_group);
  942. if (ret) {
  943. sysfs_remove_group(&dev->kobj, &qeth_l3_device_attr_group);
  944. sysfs_remove_group(&dev->kobj, &qeth_device_ipato_group);
  945. return ret;
  946. }
  947. ret = sysfs_create_group(&dev->kobj, &qeth_device_rxip_group);
  948. if (ret) {
  949. sysfs_remove_group(&dev->kobj, &qeth_l3_device_attr_group);
  950. sysfs_remove_group(&dev->kobj, &qeth_device_ipato_group);
  951. sysfs_remove_group(&dev->kobj, &qeth_device_vipa_group);
  952. return ret;
  953. }
  954. return 0;
  955. }
  956. void qeth_l3_remove_device_attributes(struct device *dev)
  957. {
  958. sysfs_remove_group(&dev->kobj, &qeth_l3_device_attr_group);
  959. sysfs_remove_group(&dev->kobj, &qeth_device_ipato_group);
  960. sysfs_remove_group(&dev->kobj, &qeth_device_vipa_group);
  961. sysfs_remove_group(&dev->kobj, &qeth_device_rxip_group);
  962. }