af_decnet.c 53 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422
  1. /*
  2. * DECnet An implementation of the DECnet protocol suite for the LINUX
  3. * operating system. DECnet is implemented using the BSD Socket
  4. * interface as the means of communication with the user level.
  5. *
  6. * DECnet Socket Layer Interface
  7. *
  8. * Authors: Eduardo Marcelo Serrat <emserrat@geocities.com>
  9. * Patrick Caulfield <patrick@pandh.demon.co.uk>
  10. *
  11. * Changes:
  12. * Steve Whitehouse: Copied from Eduardo Serrat and Patrick Caulfield's
  13. * version of the code. Original copyright preserved
  14. * below.
  15. * Steve Whitehouse: Some bug fixes, cleaning up some code to make it
  16. * compatible with my routing layer.
  17. * Steve Whitehouse: Merging changes from Eduardo Serrat and Patrick
  18. * Caulfield.
  19. * Steve Whitehouse: Further bug fixes, checking module code still works
  20. * with new routing layer.
  21. * Steve Whitehouse: Additional set/get_sockopt() calls.
  22. * Steve Whitehouse: Fixed TIOCINQ ioctl to be same as Eduardo's new
  23. * code.
  24. * Steve Whitehouse: recvmsg() changed to try and behave in a POSIX like
  25. * way. Didn't manage it entirely, but its better.
  26. * Steve Whitehouse: ditto for sendmsg().
  27. * Steve Whitehouse: A selection of bug fixes to various things.
  28. * Steve Whitehouse: Added TIOCOUTQ ioctl.
  29. * Steve Whitehouse: Fixes to username2sockaddr & sockaddr2username.
  30. * Steve Whitehouse: Fixes to connect() error returns.
  31. * Patrick Caulfield: Fixes to delayed acceptance logic.
  32. * David S. Miller: New socket locking
  33. * Steve Whitehouse: Socket list hashing/locking
  34. * Arnaldo C. Melo: use capable, not suser
  35. * Steve Whitehouse: Removed unused code. Fix to use sk->allocation
  36. * when required.
  37. * Patrick Caulfield: /proc/net/decnet now has object name/number
  38. * Steve Whitehouse: Fixed local port allocation, hashed sk list
  39. * Matthew Wilcox: Fixes for dn_ioctl()
  40. * Steve Whitehouse: New connect/accept logic to allow timeouts and
  41. * prepare for sendpage etc.
  42. */
  43. /******************************************************************************
  44. (c) 1995-1998 E.M. Serrat emserrat@geocities.com
  45. This program is free software; you can redistribute it and/or modify
  46. it under the terms of the GNU General Public License as published by
  47. the Free Software Foundation; either version 2 of the License, or
  48. any later version.
  49. This program is distributed in the hope that it will be useful,
  50. but WITHOUT ANY WARRANTY; without even the implied warranty of
  51. MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  52. GNU General Public License for more details.
  53. HISTORY:
  54. Version Kernel Date Author/Comments
  55. ------- ------ ---- ---------------
  56. Version 0.0.1 2.0.30 01-dic-97 Eduardo Marcelo Serrat
  57. (emserrat@geocities.com)
  58. First Development of DECnet Socket La-
  59. yer for Linux. Only supports outgoing
  60. connections.
  61. Version 0.0.2 2.1.105 20-jun-98 Patrick J. Caulfield
  62. (patrick@pandh.demon.co.uk)
  63. Port to new kernel development version.
  64. Version 0.0.3 2.1.106 25-jun-98 Eduardo Marcelo Serrat
  65. (emserrat@geocities.com)
  66. _
  67. Added support for incoming connections
  68. so we can start developing server apps
  69. on Linux.
  70. -
  71. Module Support
  72. Version 0.0.4 2.1.109 21-jul-98 Eduardo Marcelo Serrat
  73. (emserrat@geocities.com)
  74. _
  75. Added support for X11R6.4. Now we can
  76. use DECnet transport for X on Linux!!!
  77. -
  78. Version 0.0.5 2.1.110 01-aug-98 Eduardo Marcelo Serrat
  79. (emserrat@geocities.com)
  80. Removed bugs on flow control
  81. Removed bugs on incoming accessdata
  82. order
  83. -
  84. Version 0.0.6 2.1.110 07-aug-98 Eduardo Marcelo Serrat
  85. dn_recvmsg fixes
  86. Patrick J. Caulfield
  87. dn_bind fixes
  88. *******************************************************************************/
  89. #include <linux/module.h>
  90. #include <linux/errno.h>
  91. #include <linux/types.h>
  92. #include <linux/slab.h>
  93. #include <linux/socket.h>
  94. #include <linux/in.h>
  95. #include <linux/kernel.h>
  96. #include <linux/sched/signal.h>
  97. #include <linux/timer.h>
  98. #include <linux/string.h>
  99. #include <linux/sockios.h>
  100. #include <linux/net.h>
  101. #include <linux/netdevice.h>
  102. #include <linux/inet.h>
  103. #include <linux/route.h>
  104. #include <linux/netfilter.h>
  105. #include <linux/seq_file.h>
  106. #include <net/sock.h>
  107. #include <net/tcp_states.h>
  108. #include <net/flow.h>
  109. #include <asm/ioctls.h>
  110. #include <linux/capability.h>
  111. #include <linux/mm.h>
  112. #include <linux/interrupt.h>
  113. #include <linux/proc_fs.h>
  114. #include <linux/stat.h>
  115. #include <linux/init.h>
  116. #include <linux/poll.h>
  117. #include <linux/jiffies.h>
  118. #include <net/net_namespace.h>
  119. #include <net/neighbour.h>
  120. #include <net/dst.h>
  121. #include <net/fib_rules.h>
  122. #include <net/tcp.h>
  123. #include <net/dn.h>
  124. #include <net/dn_nsp.h>
  125. #include <net/dn_dev.h>
  126. #include <net/dn_route.h>
  127. #include <net/dn_fib.h>
  128. #include <net/dn_neigh.h>
  129. struct dn_sock {
  130. struct sock sk;
  131. struct dn_scp scp;
  132. };
  133. static void dn_keepalive(struct sock *sk);
  134. #define DN_SK_HASH_SHIFT 8
  135. #define DN_SK_HASH_SIZE (1 << DN_SK_HASH_SHIFT)
  136. #define DN_SK_HASH_MASK (DN_SK_HASH_SIZE - 1)
  137. static const struct proto_ops dn_proto_ops;
  138. static DEFINE_RWLOCK(dn_hash_lock);
  139. static struct hlist_head dn_sk_hash[DN_SK_HASH_SIZE];
  140. static struct hlist_head dn_wild_sk;
  141. static atomic_long_t decnet_memory_allocated;
  142. static int __dn_setsockopt(struct socket *sock, int level, int optname, char __user *optval, unsigned int optlen, int flags);
  143. static int __dn_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen, int flags);
  144. static struct hlist_head *dn_find_list(struct sock *sk)
  145. {
  146. struct dn_scp *scp = DN_SK(sk);
  147. if (scp->addr.sdn_flags & SDF_WILD)
  148. return hlist_empty(&dn_wild_sk) ? &dn_wild_sk : NULL;
  149. return &dn_sk_hash[le16_to_cpu(scp->addrloc) & DN_SK_HASH_MASK];
  150. }
  151. /*
  152. * Valid ports are those greater than zero and not already in use.
  153. */
  154. static int check_port(__le16 port)
  155. {
  156. struct sock *sk;
  157. if (port == 0)
  158. return -1;
  159. sk_for_each(sk, &dn_sk_hash[le16_to_cpu(port) & DN_SK_HASH_MASK]) {
  160. struct dn_scp *scp = DN_SK(sk);
  161. if (scp->addrloc == port)
  162. return -1;
  163. }
  164. return 0;
  165. }
  166. static unsigned short port_alloc(struct sock *sk)
  167. {
  168. struct dn_scp *scp = DN_SK(sk);
  169. static unsigned short port = 0x2000;
  170. unsigned short i_port = port;
  171. while(check_port(cpu_to_le16(++port)) != 0) {
  172. if (port == i_port)
  173. return 0;
  174. }
  175. scp->addrloc = cpu_to_le16(port);
  176. return 1;
  177. }
  178. /*
  179. * Since this is only ever called from user
  180. * level, we don't need a write_lock() version
  181. * of this.
  182. */
  183. static int dn_hash_sock(struct sock *sk)
  184. {
  185. struct dn_scp *scp = DN_SK(sk);
  186. struct hlist_head *list;
  187. int rv = -EUSERS;
  188. BUG_ON(sk_hashed(sk));
  189. write_lock_bh(&dn_hash_lock);
  190. if (!scp->addrloc && !port_alloc(sk))
  191. goto out;
  192. rv = -EADDRINUSE;
  193. if ((list = dn_find_list(sk)) == NULL)
  194. goto out;
  195. sk_add_node(sk, list);
  196. rv = 0;
  197. out:
  198. write_unlock_bh(&dn_hash_lock);
  199. return rv;
  200. }
  201. static void dn_unhash_sock(struct sock *sk)
  202. {
  203. write_lock(&dn_hash_lock);
  204. sk_del_node_init(sk);
  205. write_unlock(&dn_hash_lock);
  206. }
  207. static void dn_unhash_sock_bh(struct sock *sk)
  208. {
  209. write_lock_bh(&dn_hash_lock);
  210. sk_del_node_init(sk);
  211. write_unlock_bh(&dn_hash_lock);
  212. }
  213. static struct hlist_head *listen_hash(struct sockaddr_dn *addr)
  214. {
  215. int i;
  216. unsigned int hash = addr->sdn_objnum;
  217. if (hash == 0) {
  218. hash = addr->sdn_objnamel;
  219. for(i = 0; i < le16_to_cpu(addr->sdn_objnamel); i++) {
  220. hash ^= addr->sdn_objname[i];
  221. hash ^= (hash << 3);
  222. }
  223. }
  224. return &dn_sk_hash[hash & DN_SK_HASH_MASK];
  225. }
  226. /*
  227. * Called to transform a socket from bound (i.e. with a local address)
  228. * into a listening socket (doesn't need a local port number) and rehashes
  229. * based upon the object name/number.
  230. */
  231. static void dn_rehash_sock(struct sock *sk)
  232. {
  233. struct hlist_head *list;
  234. struct dn_scp *scp = DN_SK(sk);
  235. if (scp->addr.sdn_flags & SDF_WILD)
  236. return;
  237. write_lock_bh(&dn_hash_lock);
  238. sk_del_node_init(sk);
  239. DN_SK(sk)->addrloc = 0;
  240. list = listen_hash(&DN_SK(sk)->addr);
  241. sk_add_node(sk, list);
  242. write_unlock_bh(&dn_hash_lock);
  243. }
  244. int dn_sockaddr2username(struct sockaddr_dn *sdn, unsigned char *buf, unsigned char type)
  245. {
  246. int len = 2;
  247. *buf++ = type;
  248. switch (type) {
  249. case 0:
  250. *buf++ = sdn->sdn_objnum;
  251. break;
  252. case 1:
  253. *buf++ = 0;
  254. *buf++ = le16_to_cpu(sdn->sdn_objnamel);
  255. memcpy(buf, sdn->sdn_objname, le16_to_cpu(sdn->sdn_objnamel));
  256. len = 3 + le16_to_cpu(sdn->sdn_objnamel);
  257. break;
  258. case 2:
  259. memset(buf, 0, 5);
  260. buf += 5;
  261. *buf++ = le16_to_cpu(sdn->sdn_objnamel);
  262. memcpy(buf, sdn->sdn_objname, le16_to_cpu(sdn->sdn_objnamel));
  263. len = 7 + le16_to_cpu(sdn->sdn_objnamel);
  264. break;
  265. }
  266. return len;
  267. }
  268. /*
  269. * On reception of usernames, we handle types 1 and 0 for destination
  270. * addresses only. Types 2 and 4 are used for source addresses, but the
  271. * UIC, GIC are ignored and they are both treated the same way. Type 3
  272. * is never used as I've no idea what its purpose might be or what its
  273. * format is.
  274. */
  275. int dn_username2sockaddr(unsigned char *data, int len, struct sockaddr_dn *sdn, unsigned char *fmt)
  276. {
  277. unsigned char type;
  278. int size = len;
  279. int namel = 12;
  280. sdn->sdn_objnum = 0;
  281. sdn->sdn_objnamel = cpu_to_le16(0);
  282. memset(sdn->sdn_objname, 0, DN_MAXOBJL);
  283. if (len < 2)
  284. return -1;
  285. len -= 2;
  286. *fmt = *data++;
  287. type = *data++;
  288. switch (*fmt) {
  289. case 0:
  290. sdn->sdn_objnum = type;
  291. return 2;
  292. case 1:
  293. namel = 16;
  294. break;
  295. case 2:
  296. len -= 4;
  297. data += 4;
  298. break;
  299. case 4:
  300. len -= 8;
  301. data += 8;
  302. break;
  303. default:
  304. return -1;
  305. }
  306. len -= 1;
  307. if (len < 0)
  308. return -1;
  309. sdn->sdn_objnamel = cpu_to_le16(*data++);
  310. len -= le16_to_cpu(sdn->sdn_objnamel);
  311. if ((len < 0) || (le16_to_cpu(sdn->sdn_objnamel) > namel))
  312. return -1;
  313. memcpy(sdn->sdn_objname, data, le16_to_cpu(sdn->sdn_objnamel));
  314. return size - len;
  315. }
  316. struct sock *dn_sklist_find_listener(struct sockaddr_dn *addr)
  317. {
  318. struct hlist_head *list = listen_hash(addr);
  319. struct sock *sk;
  320. read_lock(&dn_hash_lock);
  321. sk_for_each(sk, list) {
  322. struct dn_scp *scp = DN_SK(sk);
  323. if (sk->sk_state != TCP_LISTEN)
  324. continue;
  325. if (scp->addr.sdn_objnum) {
  326. if (scp->addr.sdn_objnum != addr->sdn_objnum)
  327. continue;
  328. } else {
  329. if (addr->sdn_objnum)
  330. continue;
  331. if (scp->addr.sdn_objnamel != addr->sdn_objnamel)
  332. continue;
  333. if (memcmp(scp->addr.sdn_objname, addr->sdn_objname, le16_to_cpu(addr->sdn_objnamel)) != 0)
  334. continue;
  335. }
  336. sock_hold(sk);
  337. read_unlock(&dn_hash_lock);
  338. return sk;
  339. }
  340. sk = sk_head(&dn_wild_sk);
  341. if (sk) {
  342. if (sk->sk_state == TCP_LISTEN)
  343. sock_hold(sk);
  344. else
  345. sk = NULL;
  346. }
  347. read_unlock(&dn_hash_lock);
  348. return sk;
  349. }
  350. struct sock *dn_find_by_skb(struct sk_buff *skb)
  351. {
  352. struct dn_skb_cb *cb = DN_SKB_CB(skb);
  353. struct sock *sk;
  354. struct dn_scp *scp;
  355. read_lock(&dn_hash_lock);
  356. sk_for_each(sk, &dn_sk_hash[le16_to_cpu(cb->dst_port) & DN_SK_HASH_MASK]) {
  357. scp = DN_SK(sk);
  358. if (cb->src != dn_saddr2dn(&scp->peer))
  359. continue;
  360. if (cb->dst_port != scp->addrloc)
  361. continue;
  362. if (scp->addrrem && (cb->src_port != scp->addrrem))
  363. continue;
  364. sock_hold(sk);
  365. goto found;
  366. }
  367. sk = NULL;
  368. found:
  369. read_unlock(&dn_hash_lock);
  370. return sk;
  371. }
  372. static void dn_destruct(struct sock *sk)
  373. {
  374. struct dn_scp *scp = DN_SK(sk);
  375. skb_queue_purge(&scp->data_xmit_queue);
  376. skb_queue_purge(&scp->other_xmit_queue);
  377. skb_queue_purge(&scp->other_receive_queue);
  378. dst_release(rcu_dereference_check(sk->sk_dst_cache, 1));
  379. }
  380. static unsigned long dn_memory_pressure;
  381. static void dn_enter_memory_pressure(struct sock *sk)
  382. {
  383. if (!dn_memory_pressure) {
  384. dn_memory_pressure = 1;
  385. }
  386. }
  387. static struct proto dn_proto = {
  388. .name = "NSP",
  389. .owner = THIS_MODULE,
  390. .enter_memory_pressure = dn_enter_memory_pressure,
  391. .memory_pressure = &dn_memory_pressure,
  392. .memory_allocated = &decnet_memory_allocated,
  393. .sysctl_mem = sysctl_decnet_mem,
  394. .sysctl_wmem = sysctl_decnet_wmem,
  395. .sysctl_rmem = sysctl_decnet_rmem,
  396. .max_header = DN_MAX_NSP_DATA_HEADER + 64,
  397. .obj_size = sizeof(struct dn_sock),
  398. };
  399. static struct sock *dn_alloc_sock(struct net *net, struct socket *sock, gfp_t gfp, int kern)
  400. {
  401. struct dn_scp *scp;
  402. struct sock *sk = sk_alloc(net, PF_DECnet, gfp, &dn_proto, kern);
  403. if (!sk)
  404. goto out;
  405. if (sock)
  406. sock->ops = &dn_proto_ops;
  407. sock_init_data(sock, sk);
  408. sk->sk_backlog_rcv = dn_nsp_backlog_rcv;
  409. sk->sk_destruct = dn_destruct;
  410. sk->sk_no_check_tx = 1;
  411. sk->sk_family = PF_DECnet;
  412. sk->sk_protocol = 0;
  413. sk->sk_allocation = gfp;
  414. sk->sk_sndbuf = sysctl_decnet_wmem[1];
  415. sk->sk_rcvbuf = sysctl_decnet_rmem[1];
  416. /* Initialization of DECnet Session Control Port */
  417. scp = DN_SK(sk);
  418. scp->state = DN_O; /* Open */
  419. scp->numdat = 1; /* Next data seg to tx */
  420. scp->numoth = 1; /* Next oth data to tx */
  421. scp->ackxmt_dat = 0; /* Last data seg ack'ed */
  422. scp->ackxmt_oth = 0; /* Last oth data ack'ed */
  423. scp->ackrcv_dat = 0; /* Highest data ack recv*/
  424. scp->ackrcv_oth = 0; /* Last oth data ack rec*/
  425. scp->flowrem_sw = DN_SEND;
  426. scp->flowloc_sw = DN_SEND;
  427. scp->flowrem_dat = 0;
  428. scp->flowrem_oth = 1;
  429. scp->flowloc_dat = 0;
  430. scp->flowloc_oth = 1;
  431. scp->services_rem = 0;
  432. scp->services_loc = 1 | NSP_FC_NONE;
  433. scp->info_rem = 0;
  434. scp->info_loc = 0x03; /* NSP version 4.1 */
  435. scp->segsize_rem = 230 - DN_MAX_NSP_DATA_HEADER; /* Default: Updated by remote segsize */
  436. scp->nonagle = 0;
  437. scp->multi_ireq = 1;
  438. scp->accept_mode = ACC_IMMED;
  439. scp->addr.sdn_family = AF_DECnet;
  440. scp->peer.sdn_family = AF_DECnet;
  441. scp->accessdata.acc_accl = 5;
  442. memcpy(scp->accessdata.acc_acc, "LINUX", 5);
  443. scp->max_window = NSP_MAX_WINDOW;
  444. scp->snd_window = NSP_MIN_WINDOW;
  445. scp->nsp_srtt = NSP_INITIAL_SRTT;
  446. scp->nsp_rttvar = NSP_INITIAL_RTTVAR;
  447. scp->nsp_rxtshift = 0;
  448. skb_queue_head_init(&scp->data_xmit_queue);
  449. skb_queue_head_init(&scp->other_xmit_queue);
  450. skb_queue_head_init(&scp->other_receive_queue);
  451. scp->persist = 0;
  452. scp->persist_fxn = NULL;
  453. scp->keepalive = 10 * HZ;
  454. scp->keepalive_fxn = dn_keepalive;
  455. init_timer(&scp->delack_timer);
  456. scp->delack_pending = 0;
  457. scp->delack_fxn = dn_nsp_delayed_ack;
  458. dn_start_slow_timer(sk);
  459. out:
  460. return sk;
  461. }
  462. /*
  463. * Keepalive timer.
  464. * FIXME: Should respond to SO_KEEPALIVE etc.
  465. */
  466. static void dn_keepalive(struct sock *sk)
  467. {
  468. struct dn_scp *scp = DN_SK(sk);
  469. /*
  470. * By checking the other_data transmit queue is empty
  471. * we are double checking that we are not sending too
  472. * many of these keepalive frames.
  473. */
  474. if (skb_queue_empty(&scp->other_xmit_queue))
  475. dn_nsp_send_link(sk, DN_NOCHANGE, 0);
  476. }
  477. /*
  478. * Timer for shutdown/destroyed sockets.
  479. * When socket is dead & no packets have been sent for a
  480. * certain amount of time, they are removed by this
  481. * routine. Also takes care of sending out DI & DC
  482. * frames at correct times.
  483. */
  484. int dn_destroy_timer(struct sock *sk)
  485. {
  486. struct dn_scp *scp = DN_SK(sk);
  487. scp->persist = dn_nsp_persist(sk);
  488. switch (scp->state) {
  489. case DN_DI:
  490. dn_nsp_send_disc(sk, NSP_DISCINIT, 0, GFP_ATOMIC);
  491. if (scp->nsp_rxtshift >= decnet_di_count)
  492. scp->state = DN_CN;
  493. return 0;
  494. case DN_DR:
  495. dn_nsp_send_disc(sk, NSP_DISCINIT, 0, GFP_ATOMIC);
  496. if (scp->nsp_rxtshift >= decnet_dr_count)
  497. scp->state = DN_DRC;
  498. return 0;
  499. case DN_DN:
  500. if (scp->nsp_rxtshift < decnet_dn_count) {
  501. /* printk(KERN_DEBUG "dn_destroy_timer: DN\n"); */
  502. dn_nsp_send_disc(sk, NSP_DISCCONF, NSP_REASON_DC,
  503. GFP_ATOMIC);
  504. return 0;
  505. }
  506. }
  507. scp->persist = (HZ * decnet_time_wait);
  508. if (sk->sk_socket)
  509. return 0;
  510. if (time_after_eq(jiffies, scp->stamp + HZ * decnet_time_wait)) {
  511. dn_unhash_sock(sk);
  512. sock_put(sk);
  513. return 1;
  514. }
  515. return 0;
  516. }
  517. static void dn_destroy_sock(struct sock *sk)
  518. {
  519. struct dn_scp *scp = DN_SK(sk);
  520. scp->nsp_rxtshift = 0; /* reset back off */
  521. if (sk->sk_socket) {
  522. if (sk->sk_socket->state != SS_UNCONNECTED)
  523. sk->sk_socket->state = SS_DISCONNECTING;
  524. }
  525. sk->sk_state = TCP_CLOSE;
  526. switch (scp->state) {
  527. case DN_DN:
  528. dn_nsp_send_disc(sk, NSP_DISCCONF, NSP_REASON_DC,
  529. sk->sk_allocation);
  530. scp->persist_fxn = dn_destroy_timer;
  531. scp->persist = dn_nsp_persist(sk);
  532. break;
  533. case DN_CR:
  534. scp->state = DN_DR;
  535. goto disc_reject;
  536. case DN_RUN:
  537. scp->state = DN_DI;
  538. case DN_DI:
  539. case DN_DR:
  540. disc_reject:
  541. dn_nsp_send_disc(sk, NSP_DISCINIT, 0, sk->sk_allocation);
  542. case DN_NC:
  543. case DN_NR:
  544. case DN_RJ:
  545. case DN_DIC:
  546. case DN_CN:
  547. case DN_DRC:
  548. case DN_CI:
  549. case DN_CD:
  550. scp->persist_fxn = dn_destroy_timer;
  551. scp->persist = dn_nsp_persist(sk);
  552. break;
  553. default:
  554. printk(KERN_DEBUG "DECnet: dn_destroy_sock passed socket in invalid state\n");
  555. case DN_O:
  556. dn_stop_slow_timer(sk);
  557. dn_unhash_sock_bh(sk);
  558. sock_put(sk);
  559. break;
  560. }
  561. }
  562. char *dn_addr2asc(__u16 addr, char *buf)
  563. {
  564. unsigned short node, area;
  565. node = addr & 0x03ff;
  566. area = addr >> 10;
  567. sprintf(buf, "%hd.%hd", area, node);
  568. return buf;
  569. }
  570. static int dn_create(struct net *net, struct socket *sock, int protocol,
  571. int kern)
  572. {
  573. struct sock *sk;
  574. if (protocol < 0 || protocol > SK_PROTOCOL_MAX)
  575. return -EINVAL;
  576. if (!net_eq(net, &init_net))
  577. return -EAFNOSUPPORT;
  578. switch (sock->type) {
  579. case SOCK_SEQPACKET:
  580. if (protocol != DNPROTO_NSP)
  581. return -EPROTONOSUPPORT;
  582. break;
  583. case SOCK_STREAM:
  584. break;
  585. default:
  586. return -ESOCKTNOSUPPORT;
  587. }
  588. if ((sk = dn_alloc_sock(net, sock, GFP_KERNEL, kern)) == NULL)
  589. return -ENOBUFS;
  590. sk->sk_protocol = protocol;
  591. return 0;
  592. }
  593. static int
  594. dn_release(struct socket *sock)
  595. {
  596. struct sock *sk = sock->sk;
  597. if (sk) {
  598. sock_orphan(sk);
  599. sock_hold(sk);
  600. lock_sock(sk);
  601. dn_destroy_sock(sk);
  602. release_sock(sk);
  603. sock_put(sk);
  604. }
  605. return 0;
  606. }
  607. static int dn_bind(struct socket *sock, struct sockaddr *uaddr, int addr_len)
  608. {
  609. struct sock *sk = sock->sk;
  610. struct dn_scp *scp = DN_SK(sk);
  611. struct sockaddr_dn *saddr = (struct sockaddr_dn *)uaddr;
  612. struct net_device *dev, *ldev;
  613. int rv;
  614. if (addr_len != sizeof(struct sockaddr_dn))
  615. return -EINVAL;
  616. if (saddr->sdn_family != AF_DECnet)
  617. return -EINVAL;
  618. if (le16_to_cpu(saddr->sdn_nodeaddrl) && (le16_to_cpu(saddr->sdn_nodeaddrl) != 2))
  619. return -EINVAL;
  620. if (le16_to_cpu(saddr->sdn_objnamel) > DN_MAXOBJL)
  621. return -EINVAL;
  622. if (saddr->sdn_flags & ~SDF_WILD)
  623. return -EINVAL;
  624. if (!capable(CAP_NET_BIND_SERVICE) && (saddr->sdn_objnum ||
  625. (saddr->sdn_flags & SDF_WILD)))
  626. return -EACCES;
  627. if (!(saddr->sdn_flags & SDF_WILD)) {
  628. if (le16_to_cpu(saddr->sdn_nodeaddrl)) {
  629. rcu_read_lock();
  630. ldev = NULL;
  631. for_each_netdev_rcu(&init_net, dev) {
  632. if (!dev->dn_ptr)
  633. continue;
  634. if (dn_dev_islocal(dev, dn_saddr2dn(saddr))) {
  635. ldev = dev;
  636. break;
  637. }
  638. }
  639. rcu_read_unlock();
  640. if (ldev == NULL)
  641. return -EADDRNOTAVAIL;
  642. }
  643. }
  644. rv = -EINVAL;
  645. lock_sock(sk);
  646. if (sock_flag(sk, SOCK_ZAPPED)) {
  647. memcpy(&scp->addr, saddr, addr_len);
  648. sock_reset_flag(sk, SOCK_ZAPPED);
  649. rv = dn_hash_sock(sk);
  650. if (rv)
  651. sock_set_flag(sk, SOCK_ZAPPED);
  652. }
  653. release_sock(sk);
  654. return rv;
  655. }
  656. static int dn_auto_bind(struct socket *sock)
  657. {
  658. struct sock *sk = sock->sk;
  659. struct dn_scp *scp = DN_SK(sk);
  660. int rv;
  661. sock_reset_flag(sk, SOCK_ZAPPED);
  662. scp->addr.sdn_flags = 0;
  663. scp->addr.sdn_objnum = 0;
  664. /*
  665. * This stuff is to keep compatibility with Eduardo's
  666. * patch. I hope I can dispense with it shortly...
  667. */
  668. if ((scp->accessdata.acc_accl != 0) &&
  669. (scp->accessdata.acc_accl <= 12)) {
  670. scp->addr.sdn_objnamel = cpu_to_le16(scp->accessdata.acc_accl);
  671. memcpy(scp->addr.sdn_objname, scp->accessdata.acc_acc, le16_to_cpu(scp->addr.sdn_objnamel));
  672. scp->accessdata.acc_accl = 0;
  673. memset(scp->accessdata.acc_acc, 0, 40);
  674. }
  675. /* End of compatibility stuff */
  676. scp->addr.sdn_add.a_len = cpu_to_le16(2);
  677. rv = dn_dev_bind_default((__le16 *)scp->addr.sdn_add.a_addr);
  678. if (rv == 0) {
  679. rv = dn_hash_sock(sk);
  680. if (rv)
  681. sock_set_flag(sk, SOCK_ZAPPED);
  682. }
  683. return rv;
  684. }
  685. static int dn_confirm_accept(struct sock *sk, long *timeo, gfp_t allocation)
  686. {
  687. struct dn_scp *scp = DN_SK(sk);
  688. DEFINE_WAIT(wait);
  689. int err;
  690. if (scp->state != DN_CR)
  691. return -EINVAL;
  692. scp->state = DN_CC;
  693. scp->segsize_loc = dst_metric_advmss(__sk_dst_get(sk));
  694. dn_send_conn_conf(sk, allocation);
  695. prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  696. for(;;) {
  697. release_sock(sk);
  698. if (scp->state == DN_CC)
  699. *timeo = schedule_timeout(*timeo);
  700. lock_sock(sk);
  701. err = 0;
  702. if (scp->state == DN_RUN)
  703. break;
  704. err = sock_error(sk);
  705. if (err)
  706. break;
  707. err = sock_intr_errno(*timeo);
  708. if (signal_pending(current))
  709. break;
  710. err = -EAGAIN;
  711. if (!*timeo)
  712. break;
  713. prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  714. }
  715. finish_wait(sk_sleep(sk), &wait);
  716. if (err == 0) {
  717. sk->sk_socket->state = SS_CONNECTED;
  718. } else if (scp->state != DN_CC) {
  719. sk->sk_socket->state = SS_UNCONNECTED;
  720. }
  721. return err;
  722. }
  723. static int dn_wait_run(struct sock *sk, long *timeo)
  724. {
  725. struct dn_scp *scp = DN_SK(sk);
  726. DEFINE_WAIT(wait);
  727. int err = 0;
  728. if (scp->state == DN_RUN)
  729. goto out;
  730. if (!*timeo)
  731. return -EALREADY;
  732. prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  733. for(;;) {
  734. release_sock(sk);
  735. if (scp->state == DN_CI || scp->state == DN_CC)
  736. *timeo = schedule_timeout(*timeo);
  737. lock_sock(sk);
  738. err = 0;
  739. if (scp->state == DN_RUN)
  740. break;
  741. err = sock_error(sk);
  742. if (err)
  743. break;
  744. err = sock_intr_errno(*timeo);
  745. if (signal_pending(current))
  746. break;
  747. err = -ETIMEDOUT;
  748. if (!*timeo)
  749. break;
  750. prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  751. }
  752. finish_wait(sk_sleep(sk), &wait);
  753. out:
  754. if (err == 0) {
  755. sk->sk_socket->state = SS_CONNECTED;
  756. } else if (scp->state != DN_CI && scp->state != DN_CC) {
  757. sk->sk_socket->state = SS_UNCONNECTED;
  758. }
  759. return err;
  760. }
  761. static int __dn_connect(struct sock *sk, struct sockaddr_dn *addr, int addrlen, long *timeo, int flags)
  762. {
  763. struct socket *sock = sk->sk_socket;
  764. struct dn_scp *scp = DN_SK(sk);
  765. int err = -EISCONN;
  766. struct flowidn fld;
  767. struct dst_entry *dst;
  768. if (sock->state == SS_CONNECTED)
  769. goto out;
  770. if (sock->state == SS_CONNECTING) {
  771. err = 0;
  772. if (scp->state == DN_RUN) {
  773. sock->state = SS_CONNECTED;
  774. goto out;
  775. }
  776. err = -ECONNREFUSED;
  777. if (scp->state != DN_CI && scp->state != DN_CC) {
  778. sock->state = SS_UNCONNECTED;
  779. goto out;
  780. }
  781. return dn_wait_run(sk, timeo);
  782. }
  783. err = -EINVAL;
  784. if (scp->state != DN_O)
  785. goto out;
  786. if (addr == NULL || addrlen != sizeof(struct sockaddr_dn))
  787. goto out;
  788. if (addr->sdn_family != AF_DECnet)
  789. goto out;
  790. if (addr->sdn_flags & SDF_WILD)
  791. goto out;
  792. if (sock_flag(sk, SOCK_ZAPPED)) {
  793. err = dn_auto_bind(sk->sk_socket);
  794. if (err)
  795. goto out;
  796. }
  797. memcpy(&scp->peer, addr, sizeof(struct sockaddr_dn));
  798. err = -EHOSTUNREACH;
  799. memset(&fld, 0, sizeof(fld));
  800. fld.flowidn_oif = sk->sk_bound_dev_if;
  801. fld.daddr = dn_saddr2dn(&scp->peer);
  802. fld.saddr = dn_saddr2dn(&scp->addr);
  803. dn_sk_ports_copy(&fld, scp);
  804. fld.flowidn_proto = DNPROTO_NSP;
  805. if (dn_route_output_sock(&sk->sk_dst_cache, &fld, sk, flags) < 0)
  806. goto out;
  807. dst = __sk_dst_get(sk);
  808. sk->sk_route_caps = dst->dev->features;
  809. sock->state = SS_CONNECTING;
  810. scp->state = DN_CI;
  811. scp->segsize_loc = dst_metric_advmss(dst);
  812. dn_nsp_send_conninit(sk, NSP_CI);
  813. err = -EINPROGRESS;
  814. if (*timeo) {
  815. err = dn_wait_run(sk, timeo);
  816. }
  817. out:
  818. return err;
  819. }
  820. static int dn_connect(struct socket *sock, struct sockaddr *uaddr, int addrlen, int flags)
  821. {
  822. struct sockaddr_dn *addr = (struct sockaddr_dn *)uaddr;
  823. struct sock *sk = sock->sk;
  824. int err;
  825. long timeo = sock_sndtimeo(sk, flags & O_NONBLOCK);
  826. lock_sock(sk);
  827. err = __dn_connect(sk, addr, addrlen, &timeo, 0);
  828. release_sock(sk);
  829. return err;
  830. }
  831. static inline int dn_check_state(struct sock *sk, struct sockaddr_dn *addr, int addrlen, long *timeo, int flags)
  832. {
  833. struct dn_scp *scp = DN_SK(sk);
  834. switch (scp->state) {
  835. case DN_RUN:
  836. return 0;
  837. case DN_CR:
  838. return dn_confirm_accept(sk, timeo, sk->sk_allocation);
  839. case DN_CI:
  840. case DN_CC:
  841. return dn_wait_run(sk, timeo);
  842. case DN_O:
  843. return __dn_connect(sk, addr, addrlen, timeo, flags);
  844. }
  845. return -EINVAL;
  846. }
  847. static void dn_access_copy(struct sk_buff *skb, struct accessdata_dn *acc)
  848. {
  849. unsigned char *ptr = skb->data;
  850. acc->acc_userl = *ptr++;
  851. memcpy(&acc->acc_user, ptr, acc->acc_userl);
  852. ptr += acc->acc_userl;
  853. acc->acc_passl = *ptr++;
  854. memcpy(&acc->acc_pass, ptr, acc->acc_passl);
  855. ptr += acc->acc_passl;
  856. acc->acc_accl = *ptr++;
  857. memcpy(&acc->acc_acc, ptr, acc->acc_accl);
  858. skb_pull(skb, acc->acc_accl + acc->acc_passl + acc->acc_userl + 3);
  859. }
  860. static void dn_user_copy(struct sk_buff *skb, struct optdata_dn *opt)
  861. {
  862. unsigned char *ptr = skb->data;
  863. u16 len = *ptr++; /* yes, it's 8bit on the wire */
  864. BUG_ON(len > 16); /* we've checked the contents earlier */
  865. opt->opt_optl = cpu_to_le16(len);
  866. opt->opt_status = 0;
  867. memcpy(opt->opt_data, ptr, len);
  868. skb_pull(skb, len + 1);
  869. }
  870. static struct sk_buff *dn_wait_for_connect(struct sock *sk, long *timeo)
  871. {
  872. DEFINE_WAIT(wait);
  873. struct sk_buff *skb = NULL;
  874. int err = 0;
  875. prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  876. for(;;) {
  877. release_sock(sk);
  878. skb = skb_dequeue(&sk->sk_receive_queue);
  879. if (skb == NULL) {
  880. *timeo = schedule_timeout(*timeo);
  881. skb = skb_dequeue(&sk->sk_receive_queue);
  882. }
  883. lock_sock(sk);
  884. if (skb != NULL)
  885. break;
  886. err = -EINVAL;
  887. if (sk->sk_state != TCP_LISTEN)
  888. break;
  889. err = sock_intr_errno(*timeo);
  890. if (signal_pending(current))
  891. break;
  892. err = -EAGAIN;
  893. if (!*timeo)
  894. break;
  895. prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
  896. }
  897. finish_wait(sk_sleep(sk), &wait);
  898. return skb == NULL ? ERR_PTR(err) : skb;
  899. }
  900. static int dn_accept(struct socket *sock, struct socket *newsock, int flags,
  901. bool kern)
  902. {
  903. struct sock *sk = sock->sk, *newsk;
  904. struct sk_buff *skb = NULL;
  905. struct dn_skb_cb *cb;
  906. unsigned char menuver;
  907. int err = 0;
  908. unsigned char type;
  909. long timeo = sock_rcvtimeo(sk, flags & O_NONBLOCK);
  910. struct dst_entry *dst;
  911. lock_sock(sk);
  912. if (sk->sk_state != TCP_LISTEN || DN_SK(sk)->state != DN_O) {
  913. release_sock(sk);
  914. return -EINVAL;
  915. }
  916. skb = skb_dequeue(&sk->sk_receive_queue);
  917. if (skb == NULL) {
  918. skb = dn_wait_for_connect(sk, &timeo);
  919. if (IS_ERR(skb)) {
  920. release_sock(sk);
  921. return PTR_ERR(skb);
  922. }
  923. }
  924. cb = DN_SKB_CB(skb);
  925. sk->sk_ack_backlog--;
  926. newsk = dn_alloc_sock(sock_net(sk), newsock, sk->sk_allocation, kern);
  927. if (newsk == NULL) {
  928. release_sock(sk);
  929. kfree_skb(skb);
  930. return -ENOBUFS;
  931. }
  932. release_sock(sk);
  933. dst = skb_dst(skb);
  934. sk_dst_set(newsk, dst);
  935. skb_dst_set(skb, NULL);
  936. DN_SK(newsk)->state = DN_CR;
  937. DN_SK(newsk)->addrrem = cb->src_port;
  938. DN_SK(newsk)->services_rem = cb->services;
  939. DN_SK(newsk)->info_rem = cb->info;
  940. DN_SK(newsk)->segsize_rem = cb->segsize;
  941. DN_SK(newsk)->accept_mode = DN_SK(sk)->accept_mode;
  942. if (DN_SK(newsk)->segsize_rem < 230)
  943. DN_SK(newsk)->segsize_rem = 230;
  944. if ((DN_SK(newsk)->services_rem & NSP_FC_MASK) == NSP_FC_NONE)
  945. DN_SK(newsk)->max_window = decnet_no_fc_max_cwnd;
  946. newsk->sk_state = TCP_LISTEN;
  947. memcpy(&(DN_SK(newsk)->addr), &(DN_SK(sk)->addr), sizeof(struct sockaddr_dn));
  948. /*
  949. * If we are listening on a wild socket, we don't want
  950. * the newly created socket on the wrong hash queue.
  951. */
  952. DN_SK(newsk)->addr.sdn_flags &= ~SDF_WILD;
  953. skb_pull(skb, dn_username2sockaddr(skb->data, skb->len, &(DN_SK(newsk)->addr), &type));
  954. skb_pull(skb, dn_username2sockaddr(skb->data, skb->len, &(DN_SK(newsk)->peer), &type));
  955. *(__le16 *)(DN_SK(newsk)->peer.sdn_add.a_addr) = cb->src;
  956. *(__le16 *)(DN_SK(newsk)->addr.sdn_add.a_addr) = cb->dst;
  957. menuver = *skb->data;
  958. skb_pull(skb, 1);
  959. if (menuver & DN_MENUVER_ACC)
  960. dn_access_copy(skb, &(DN_SK(newsk)->accessdata));
  961. if (menuver & DN_MENUVER_USR)
  962. dn_user_copy(skb, &(DN_SK(newsk)->conndata_in));
  963. if (menuver & DN_MENUVER_PRX)
  964. DN_SK(newsk)->peer.sdn_flags |= SDF_PROXY;
  965. if (menuver & DN_MENUVER_UIC)
  966. DN_SK(newsk)->peer.sdn_flags |= SDF_UICPROXY;
  967. kfree_skb(skb);
  968. memcpy(&(DN_SK(newsk)->conndata_out), &(DN_SK(sk)->conndata_out),
  969. sizeof(struct optdata_dn));
  970. memcpy(&(DN_SK(newsk)->discdata_out), &(DN_SK(sk)->discdata_out),
  971. sizeof(struct optdata_dn));
  972. lock_sock(newsk);
  973. err = dn_hash_sock(newsk);
  974. if (err == 0) {
  975. sock_reset_flag(newsk, SOCK_ZAPPED);
  976. dn_send_conn_ack(newsk);
  977. /*
  978. * Here we use sk->sk_allocation since although the conn conf is
  979. * for the newsk, the context is the old socket.
  980. */
  981. if (DN_SK(newsk)->accept_mode == ACC_IMMED)
  982. err = dn_confirm_accept(newsk, &timeo,
  983. sk->sk_allocation);
  984. }
  985. release_sock(newsk);
  986. return err;
  987. }
  988. static int dn_getname(struct socket *sock, struct sockaddr *uaddr,int *uaddr_len,int peer)
  989. {
  990. struct sockaddr_dn *sa = (struct sockaddr_dn *)uaddr;
  991. struct sock *sk = sock->sk;
  992. struct dn_scp *scp = DN_SK(sk);
  993. *uaddr_len = sizeof(struct sockaddr_dn);
  994. lock_sock(sk);
  995. if (peer) {
  996. if ((sock->state != SS_CONNECTED &&
  997. sock->state != SS_CONNECTING) &&
  998. scp->accept_mode == ACC_IMMED) {
  999. release_sock(sk);
  1000. return -ENOTCONN;
  1001. }
  1002. memcpy(sa, &scp->peer, sizeof(struct sockaddr_dn));
  1003. } else {
  1004. memcpy(sa, &scp->addr, sizeof(struct sockaddr_dn));
  1005. }
  1006. release_sock(sk);
  1007. return 0;
  1008. }
  1009. static unsigned int dn_poll(struct file *file, struct socket *sock, poll_table *wait)
  1010. {
  1011. struct sock *sk = sock->sk;
  1012. struct dn_scp *scp = DN_SK(sk);
  1013. int mask = datagram_poll(file, sock, wait);
  1014. if (!skb_queue_empty(&scp->other_receive_queue))
  1015. mask |= POLLRDBAND;
  1016. return mask;
  1017. }
  1018. static int dn_ioctl(struct socket *sock, unsigned int cmd, unsigned long arg)
  1019. {
  1020. struct sock *sk = sock->sk;
  1021. struct dn_scp *scp = DN_SK(sk);
  1022. int err = -EOPNOTSUPP;
  1023. long amount = 0;
  1024. struct sk_buff *skb;
  1025. int val;
  1026. switch(cmd)
  1027. {
  1028. case SIOCGIFADDR:
  1029. case SIOCSIFADDR:
  1030. return dn_dev_ioctl(cmd, (void __user *)arg);
  1031. case SIOCATMARK:
  1032. lock_sock(sk);
  1033. val = !skb_queue_empty(&scp->other_receive_queue);
  1034. if (scp->state != DN_RUN)
  1035. val = -ENOTCONN;
  1036. release_sock(sk);
  1037. return val;
  1038. case TIOCOUTQ:
  1039. amount = sk->sk_sndbuf - sk_wmem_alloc_get(sk);
  1040. if (amount < 0)
  1041. amount = 0;
  1042. err = put_user(amount, (int __user *)arg);
  1043. break;
  1044. case TIOCINQ:
  1045. lock_sock(sk);
  1046. skb = skb_peek(&scp->other_receive_queue);
  1047. if (skb) {
  1048. amount = skb->len;
  1049. } else {
  1050. skb_queue_walk(&sk->sk_receive_queue, skb)
  1051. amount += skb->len;
  1052. }
  1053. release_sock(sk);
  1054. err = put_user(amount, (int __user *)arg);
  1055. break;
  1056. default:
  1057. err = -ENOIOCTLCMD;
  1058. break;
  1059. }
  1060. return err;
  1061. }
  1062. static int dn_listen(struct socket *sock, int backlog)
  1063. {
  1064. struct sock *sk = sock->sk;
  1065. int err = -EINVAL;
  1066. lock_sock(sk);
  1067. if (sock_flag(sk, SOCK_ZAPPED))
  1068. goto out;
  1069. if ((DN_SK(sk)->state != DN_O) || (sk->sk_state == TCP_LISTEN))
  1070. goto out;
  1071. sk->sk_max_ack_backlog = backlog;
  1072. sk->sk_ack_backlog = 0;
  1073. sk->sk_state = TCP_LISTEN;
  1074. err = 0;
  1075. dn_rehash_sock(sk);
  1076. out:
  1077. release_sock(sk);
  1078. return err;
  1079. }
  1080. static int dn_shutdown(struct socket *sock, int how)
  1081. {
  1082. struct sock *sk = sock->sk;
  1083. struct dn_scp *scp = DN_SK(sk);
  1084. int err = -ENOTCONN;
  1085. lock_sock(sk);
  1086. if (sock->state == SS_UNCONNECTED)
  1087. goto out;
  1088. err = 0;
  1089. if (sock->state == SS_DISCONNECTING)
  1090. goto out;
  1091. err = -EINVAL;
  1092. if (scp->state == DN_O)
  1093. goto out;
  1094. if (how != SHUT_RDWR)
  1095. goto out;
  1096. sk->sk_shutdown = SHUTDOWN_MASK;
  1097. dn_destroy_sock(sk);
  1098. err = 0;
  1099. out:
  1100. release_sock(sk);
  1101. return err;
  1102. }
  1103. static int dn_setsockopt(struct socket *sock, int level, int optname, char __user *optval, unsigned int optlen)
  1104. {
  1105. struct sock *sk = sock->sk;
  1106. int err;
  1107. lock_sock(sk);
  1108. err = __dn_setsockopt(sock, level, optname, optval, optlen, 0);
  1109. release_sock(sk);
  1110. return err;
  1111. }
  1112. static int __dn_setsockopt(struct socket *sock, int level,int optname, char __user *optval, unsigned int optlen, int flags)
  1113. {
  1114. struct sock *sk = sock->sk;
  1115. struct dn_scp *scp = DN_SK(sk);
  1116. long timeo;
  1117. union {
  1118. struct optdata_dn opt;
  1119. struct accessdata_dn acc;
  1120. int mode;
  1121. unsigned long win;
  1122. int val;
  1123. unsigned char services;
  1124. unsigned char info;
  1125. } u;
  1126. int err;
  1127. if (optlen && !optval)
  1128. return -EINVAL;
  1129. if (optlen > sizeof(u))
  1130. return -EINVAL;
  1131. if (copy_from_user(&u, optval, optlen))
  1132. return -EFAULT;
  1133. switch (optname) {
  1134. case DSO_CONDATA:
  1135. if (sock->state == SS_CONNECTED)
  1136. return -EISCONN;
  1137. if ((scp->state != DN_O) && (scp->state != DN_CR))
  1138. return -EINVAL;
  1139. if (optlen != sizeof(struct optdata_dn))
  1140. return -EINVAL;
  1141. if (le16_to_cpu(u.opt.opt_optl) > 16)
  1142. return -EINVAL;
  1143. memcpy(&scp->conndata_out, &u.opt, optlen);
  1144. break;
  1145. case DSO_DISDATA:
  1146. if (sock->state != SS_CONNECTED &&
  1147. scp->accept_mode == ACC_IMMED)
  1148. return -ENOTCONN;
  1149. if (optlen != sizeof(struct optdata_dn))
  1150. return -EINVAL;
  1151. if (le16_to_cpu(u.opt.opt_optl) > 16)
  1152. return -EINVAL;
  1153. memcpy(&scp->discdata_out, &u.opt, optlen);
  1154. break;
  1155. case DSO_CONACCESS:
  1156. if (sock->state == SS_CONNECTED)
  1157. return -EISCONN;
  1158. if (scp->state != DN_O)
  1159. return -EINVAL;
  1160. if (optlen != sizeof(struct accessdata_dn))
  1161. return -EINVAL;
  1162. if ((u.acc.acc_accl > DN_MAXACCL) ||
  1163. (u.acc.acc_passl > DN_MAXACCL) ||
  1164. (u.acc.acc_userl > DN_MAXACCL))
  1165. return -EINVAL;
  1166. memcpy(&scp->accessdata, &u.acc, optlen);
  1167. break;
  1168. case DSO_ACCEPTMODE:
  1169. if (sock->state == SS_CONNECTED)
  1170. return -EISCONN;
  1171. if (scp->state != DN_O)
  1172. return -EINVAL;
  1173. if (optlen != sizeof(int))
  1174. return -EINVAL;
  1175. if ((u.mode != ACC_IMMED) && (u.mode != ACC_DEFER))
  1176. return -EINVAL;
  1177. scp->accept_mode = (unsigned char)u.mode;
  1178. break;
  1179. case DSO_CONACCEPT:
  1180. if (scp->state != DN_CR)
  1181. return -EINVAL;
  1182. timeo = sock_rcvtimeo(sk, 0);
  1183. err = dn_confirm_accept(sk, &timeo, sk->sk_allocation);
  1184. return err;
  1185. case DSO_CONREJECT:
  1186. if (scp->state != DN_CR)
  1187. return -EINVAL;
  1188. scp->state = DN_DR;
  1189. sk->sk_shutdown = SHUTDOWN_MASK;
  1190. dn_nsp_send_disc(sk, 0x38, 0, sk->sk_allocation);
  1191. break;
  1192. default:
  1193. #ifdef CONFIG_NETFILTER
  1194. return nf_setsockopt(sk, PF_DECnet, optname, optval, optlen);
  1195. #endif
  1196. case DSO_LINKINFO:
  1197. case DSO_STREAM:
  1198. case DSO_SEQPACKET:
  1199. return -ENOPROTOOPT;
  1200. case DSO_MAXWINDOW:
  1201. if (optlen != sizeof(unsigned long))
  1202. return -EINVAL;
  1203. if (u.win > NSP_MAX_WINDOW)
  1204. u.win = NSP_MAX_WINDOW;
  1205. if (u.win == 0)
  1206. return -EINVAL;
  1207. scp->max_window = u.win;
  1208. if (scp->snd_window > u.win)
  1209. scp->snd_window = u.win;
  1210. break;
  1211. case DSO_NODELAY:
  1212. if (optlen != sizeof(int))
  1213. return -EINVAL;
  1214. if (scp->nonagle == TCP_NAGLE_CORK)
  1215. return -EINVAL;
  1216. scp->nonagle = (u.val == 0) ? 0 : TCP_NAGLE_OFF;
  1217. /* if (scp->nonagle == 1) { Push pending frames } */
  1218. break;
  1219. case DSO_CORK:
  1220. if (optlen != sizeof(int))
  1221. return -EINVAL;
  1222. if (scp->nonagle == TCP_NAGLE_OFF)
  1223. return -EINVAL;
  1224. scp->nonagle = (u.val == 0) ? 0 : TCP_NAGLE_CORK;
  1225. /* if (scp->nonagle == 0) { Push pending frames } */
  1226. break;
  1227. case DSO_SERVICES:
  1228. if (optlen != sizeof(unsigned char))
  1229. return -EINVAL;
  1230. if ((u.services & ~NSP_FC_MASK) != 0x01)
  1231. return -EINVAL;
  1232. if ((u.services & NSP_FC_MASK) == NSP_FC_MASK)
  1233. return -EINVAL;
  1234. scp->services_loc = u.services;
  1235. break;
  1236. case DSO_INFO:
  1237. if (optlen != sizeof(unsigned char))
  1238. return -EINVAL;
  1239. if (u.info & 0xfc)
  1240. return -EINVAL;
  1241. scp->info_loc = u.info;
  1242. break;
  1243. }
  1244. return 0;
  1245. }
  1246. static int dn_getsockopt(struct socket *sock, int level, int optname, char __user *optval, int __user *optlen)
  1247. {
  1248. struct sock *sk = sock->sk;
  1249. int err;
  1250. lock_sock(sk);
  1251. err = __dn_getsockopt(sock, level, optname, optval, optlen, 0);
  1252. release_sock(sk);
  1253. return err;
  1254. }
  1255. static int __dn_getsockopt(struct socket *sock, int level,int optname, char __user *optval,int __user *optlen, int flags)
  1256. {
  1257. struct sock *sk = sock->sk;
  1258. struct dn_scp *scp = DN_SK(sk);
  1259. struct linkinfo_dn link;
  1260. unsigned int r_len;
  1261. void *r_data = NULL;
  1262. unsigned int val;
  1263. if(get_user(r_len , optlen))
  1264. return -EFAULT;
  1265. switch (optname) {
  1266. case DSO_CONDATA:
  1267. if (r_len > sizeof(struct optdata_dn))
  1268. r_len = sizeof(struct optdata_dn);
  1269. r_data = &scp->conndata_in;
  1270. break;
  1271. case DSO_DISDATA:
  1272. if (r_len > sizeof(struct optdata_dn))
  1273. r_len = sizeof(struct optdata_dn);
  1274. r_data = &scp->discdata_in;
  1275. break;
  1276. case DSO_CONACCESS:
  1277. if (r_len > sizeof(struct accessdata_dn))
  1278. r_len = sizeof(struct accessdata_dn);
  1279. r_data = &scp->accessdata;
  1280. break;
  1281. case DSO_ACCEPTMODE:
  1282. if (r_len > sizeof(unsigned char))
  1283. r_len = sizeof(unsigned char);
  1284. r_data = &scp->accept_mode;
  1285. break;
  1286. case DSO_LINKINFO:
  1287. if (r_len > sizeof(struct linkinfo_dn))
  1288. r_len = sizeof(struct linkinfo_dn);
  1289. memset(&link, 0, sizeof(link));
  1290. switch (sock->state) {
  1291. case SS_CONNECTING:
  1292. link.idn_linkstate = LL_CONNECTING;
  1293. break;
  1294. case SS_DISCONNECTING:
  1295. link.idn_linkstate = LL_DISCONNECTING;
  1296. break;
  1297. case SS_CONNECTED:
  1298. link.idn_linkstate = LL_RUNNING;
  1299. break;
  1300. default:
  1301. link.idn_linkstate = LL_INACTIVE;
  1302. }
  1303. link.idn_segsize = scp->segsize_rem;
  1304. r_data = &link;
  1305. break;
  1306. default:
  1307. #ifdef CONFIG_NETFILTER
  1308. {
  1309. int ret, len;
  1310. if (get_user(len, optlen))
  1311. return -EFAULT;
  1312. ret = nf_getsockopt(sk, PF_DECnet, optname, optval, &len);
  1313. if (ret >= 0)
  1314. ret = put_user(len, optlen);
  1315. return ret;
  1316. }
  1317. #endif
  1318. case DSO_STREAM:
  1319. case DSO_SEQPACKET:
  1320. case DSO_CONACCEPT:
  1321. case DSO_CONREJECT:
  1322. return -ENOPROTOOPT;
  1323. case DSO_MAXWINDOW:
  1324. if (r_len > sizeof(unsigned long))
  1325. r_len = sizeof(unsigned long);
  1326. r_data = &scp->max_window;
  1327. break;
  1328. case DSO_NODELAY:
  1329. if (r_len > sizeof(int))
  1330. r_len = sizeof(int);
  1331. val = (scp->nonagle == TCP_NAGLE_OFF);
  1332. r_data = &val;
  1333. break;
  1334. case DSO_CORK:
  1335. if (r_len > sizeof(int))
  1336. r_len = sizeof(int);
  1337. val = (scp->nonagle == TCP_NAGLE_CORK);
  1338. r_data = &val;
  1339. break;
  1340. case DSO_SERVICES:
  1341. if (r_len > sizeof(unsigned char))
  1342. r_len = sizeof(unsigned char);
  1343. r_data = &scp->services_rem;
  1344. break;
  1345. case DSO_INFO:
  1346. if (r_len > sizeof(unsigned char))
  1347. r_len = sizeof(unsigned char);
  1348. r_data = &scp->info_rem;
  1349. break;
  1350. }
  1351. if (r_data) {
  1352. if (copy_to_user(optval, r_data, r_len))
  1353. return -EFAULT;
  1354. if (put_user(r_len, optlen))
  1355. return -EFAULT;
  1356. }
  1357. return 0;
  1358. }
  1359. static int dn_data_ready(struct sock *sk, struct sk_buff_head *q, int flags, int target)
  1360. {
  1361. struct sk_buff *skb;
  1362. int len = 0;
  1363. if (flags & MSG_OOB)
  1364. return !skb_queue_empty(q) ? 1 : 0;
  1365. skb_queue_walk(q, skb) {
  1366. struct dn_skb_cb *cb = DN_SKB_CB(skb);
  1367. len += skb->len;
  1368. if (cb->nsp_flags & 0x40) {
  1369. /* SOCK_SEQPACKET reads to EOM */
  1370. if (sk->sk_type == SOCK_SEQPACKET)
  1371. return 1;
  1372. /* so does SOCK_STREAM unless WAITALL is specified */
  1373. if (!(flags & MSG_WAITALL))
  1374. return 1;
  1375. }
  1376. /* minimum data length for read exceeded */
  1377. if (len >= target)
  1378. return 1;
  1379. }
  1380. return 0;
  1381. }
  1382. static int dn_recvmsg(struct socket *sock, struct msghdr *msg, size_t size,
  1383. int flags)
  1384. {
  1385. struct sock *sk = sock->sk;
  1386. struct dn_scp *scp = DN_SK(sk);
  1387. struct sk_buff_head *queue = &sk->sk_receive_queue;
  1388. size_t target = size > 1 ? 1 : 0;
  1389. size_t copied = 0;
  1390. int rv = 0;
  1391. struct sk_buff *skb, *n;
  1392. struct dn_skb_cb *cb = NULL;
  1393. unsigned char eor = 0;
  1394. long timeo = sock_rcvtimeo(sk, flags & MSG_DONTWAIT);
  1395. lock_sock(sk);
  1396. if (sock_flag(sk, SOCK_ZAPPED)) {
  1397. rv = -EADDRNOTAVAIL;
  1398. goto out;
  1399. }
  1400. if (sk->sk_shutdown & RCV_SHUTDOWN) {
  1401. rv = 0;
  1402. goto out;
  1403. }
  1404. rv = dn_check_state(sk, NULL, 0, &timeo, flags);
  1405. if (rv)
  1406. goto out;
  1407. if (flags & ~(MSG_CMSG_COMPAT|MSG_PEEK|MSG_OOB|MSG_WAITALL|MSG_DONTWAIT|MSG_NOSIGNAL)) {
  1408. rv = -EOPNOTSUPP;
  1409. goto out;
  1410. }
  1411. if (flags & MSG_OOB)
  1412. queue = &scp->other_receive_queue;
  1413. if (flags & MSG_WAITALL)
  1414. target = size;
  1415. /*
  1416. * See if there is data ready to read, sleep if there isn't
  1417. */
  1418. for(;;) {
  1419. DEFINE_WAIT_FUNC(wait, woken_wake_function);
  1420. if (sk->sk_err)
  1421. goto out;
  1422. if (!skb_queue_empty(&scp->other_receive_queue)) {
  1423. if (!(flags & MSG_OOB)) {
  1424. msg->msg_flags |= MSG_OOB;
  1425. if (!scp->other_report) {
  1426. scp->other_report = 1;
  1427. goto out;
  1428. }
  1429. }
  1430. }
  1431. if (scp->state != DN_RUN)
  1432. goto out;
  1433. if (signal_pending(current)) {
  1434. rv = sock_intr_errno(timeo);
  1435. goto out;
  1436. }
  1437. if (dn_data_ready(sk, queue, flags, target))
  1438. break;
  1439. if (flags & MSG_DONTWAIT) {
  1440. rv = -EWOULDBLOCK;
  1441. goto out;
  1442. }
  1443. add_wait_queue(sk_sleep(sk), &wait);
  1444. sk_set_bit(SOCKWQ_ASYNC_WAITDATA, sk);
  1445. sk_wait_event(sk, &timeo, dn_data_ready(sk, queue, flags, target), &wait);
  1446. sk_clear_bit(SOCKWQ_ASYNC_WAITDATA, sk);
  1447. remove_wait_queue(sk_sleep(sk), &wait);
  1448. }
  1449. skb_queue_walk_safe(queue, skb, n) {
  1450. unsigned int chunk = skb->len;
  1451. cb = DN_SKB_CB(skb);
  1452. if ((chunk + copied) > size)
  1453. chunk = size - copied;
  1454. if (memcpy_to_msg(msg, skb->data, chunk)) {
  1455. rv = -EFAULT;
  1456. break;
  1457. }
  1458. copied += chunk;
  1459. if (!(flags & MSG_PEEK))
  1460. skb_pull(skb, chunk);
  1461. eor = cb->nsp_flags & 0x40;
  1462. if (skb->len == 0) {
  1463. skb_unlink(skb, queue);
  1464. kfree_skb(skb);
  1465. /*
  1466. * N.B. Don't refer to skb or cb after this point
  1467. * in loop.
  1468. */
  1469. if ((scp->flowloc_sw == DN_DONTSEND) && !dn_congested(sk)) {
  1470. scp->flowloc_sw = DN_SEND;
  1471. dn_nsp_send_link(sk, DN_SEND, 0);
  1472. }
  1473. }
  1474. if (eor) {
  1475. if (sk->sk_type == SOCK_SEQPACKET)
  1476. break;
  1477. if (!(flags & MSG_WAITALL))
  1478. break;
  1479. }
  1480. if (flags & MSG_OOB)
  1481. break;
  1482. if (copied >= target)
  1483. break;
  1484. }
  1485. rv = copied;
  1486. if (eor && (sk->sk_type == SOCK_SEQPACKET))
  1487. msg->msg_flags |= MSG_EOR;
  1488. out:
  1489. if (rv == 0)
  1490. rv = (flags & MSG_PEEK) ? -sk->sk_err : sock_error(sk);
  1491. if ((rv >= 0) && msg->msg_name) {
  1492. __sockaddr_check_size(sizeof(struct sockaddr_dn));
  1493. memcpy(msg->msg_name, &scp->peer, sizeof(struct sockaddr_dn));
  1494. msg->msg_namelen = sizeof(struct sockaddr_dn);
  1495. }
  1496. release_sock(sk);
  1497. return rv;
  1498. }
  1499. static inline int dn_queue_too_long(struct dn_scp *scp, struct sk_buff_head *queue, int flags)
  1500. {
  1501. unsigned char fctype = scp->services_rem & NSP_FC_MASK;
  1502. if (skb_queue_len(queue) >= scp->snd_window)
  1503. return 1;
  1504. if (fctype != NSP_FC_NONE) {
  1505. if (flags & MSG_OOB) {
  1506. if (scp->flowrem_oth == 0)
  1507. return 1;
  1508. } else {
  1509. if (scp->flowrem_dat == 0)
  1510. return 1;
  1511. }
  1512. }
  1513. return 0;
  1514. }
  1515. /*
  1516. * The DECnet spec requires that the "routing layer" accepts packets which
  1517. * are at least 230 bytes in size. This excludes any headers which the NSP
  1518. * layer might add, so we always assume that we'll be using the maximal
  1519. * length header on data packets. The variation in length is due to the
  1520. * inclusion (or not) of the two 16 bit acknowledgement fields so it doesn't
  1521. * make much practical difference.
  1522. */
  1523. unsigned int dn_mss_from_pmtu(struct net_device *dev, int mtu)
  1524. {
  1525. unsigned int mss = 230 - DN_MAX_NSP_DATA_HEADER;
  1526. if (dev) {
  1527. struct dn_dev *dn_db = rcu_dereference_raw(dev->dn_ptr);
  1528. mtu -= LL_RESERVED_SPACE(dev);
  1529. if (dn_db->use_long)
  1530. mtu -= 21;
  1531. else
  1532. mtu -= 6;
  1533. mtu -= DN_MAX_NSP_DATA_HEADER;
  1534. } else {
  1535. /*
  1536. * 21 = long header, 16 = guess at MAC header length
  1537. */
  1538. mtu -= (21 + DN_MAX_NSP_DATA_HEADER + 16);
  1539. }
  1540. if (mtu > mss)
  1541. mss = mtu;
  1542. return mss;
  1543. }
  1544. static inline unsigned int dn_current_mss(struct sock *sk, int flags)
  1545. {
  1546. struct dst_entry *dst = __sk_dst_get(sk);
  1547. struct dn_scp *scp = DN_SK(sk);
  1548. int mss_now = min_t(int, scp->segsize_loc, scp->segsize_rem);
  1549. /* Other data messages are limited to 16 bytes per packet */
  1550. if (flags & MSG_OOB)
  1551. return 16;
  1552. /* This works out the maximum size of segment we can send out */
  1553. if (dst) {
  1554. u32 mtu = dst_mtu(dst);
  1555. mss_now = min_t(int, dn_mss_from_pmtu(dst->dev, mtu), mss_now);
  1556. }
  1557. return mss_now;
  1558. }
  1559. /*
  1560. * N.B. We get the timeout wrong here, but then we always did get it
  1561. * wrong before and this is another step along the road to correcting
  1562. * it. It ought to get updated each time we pass through the routine,
  1563. * but in practise it probably doesn't matter too much for now.
  1564. */
  1565. static inline struct sk_buff *dn_alloc_send_pskb(struct sock *sk,
  1566. unsigned long datalen, int noblock,
  1567. int *errcode)
  1568. {
  1569. struct sk_buff *skb = sock_alloc_send_skb(sk, datalen,
  1570. noblock, errcode);
  1571. if (skb) {
  1572. skb->protocol = htons(ETH_P_DNA_RT);
  1573. skb->pkt_type = PACKET_OUTGOING;
  1574. }
  1575. return skb;
  1576. }
  1577. static int dn_sendmsg(struct socket *sock, struct msghdr *msg, size_t size)
  1578. {
  1579. struct sock *sk = sock->sk;
  1580. struct dn_scp *scp = DN_SK(sk);
  1581. size_t mss;
  1582. struct sk_buff_head *queue = &scp->data_xmit_queue;
  1583. int flags = msg->msg_flags;
  1584. int err = 0;
  1585. size_t sent = 0;
  1586. int addr_len = msg->msg_namelen;
  1587. DECLARE_SOCKADDR(struct sockaddr_dn *, addr, msg->msg_name);
  1588. struct sk_buff *skb = NULL;
  1589. struct dn_skb_cb *cb;
  1590. size_t len;
  1591. unsigned char fctype;
  1592. long timeo;
  1593. if (flags & ~(MSG_TRYHARD|MSG_OOB|MSG_DONTWAIT|MSG_EOR|MSG_NOSIGNAL|MSG_MORE|MSG_CMSG_COMPAT))
  1594. return -EOPNOTSUPP;
  1595. if (addr_len && (addr_len != sizeof(struct sockaddr_dn)))
  1596. return -EINVAL;
  1597. lock_sock(sk);
  1598. timeo = sock_sndtimeo(sk, flags & MSG_DONTWAIT);
  1599. /*
  1600. * The only difference between stream sockets and sequenced packet
  1601. * sockets is that the stream sockets always behave as if MSG_EOR
  1602. * has been set.
  1603. */
  1604. if (sock->type == SOCK_STREAM) {
  1605. if (flags & MSG_EOR) {
  1606. err = -EINVAL;
  1607. goto out;
  1608. }
  1609. flags |= MSG_EOR;
  1610. }
  1611. err = dn_check_state(sk, addr, addr_len, &timeo, flags);
  1612. if (err)
  1613. goto out_err;
  1614. if (sk->sk_shutdown & SEND_SHUTDOWN) {
  1615. err = -EPIPE;
  1616. if (!(flags & MSG_NOSIGNAL))
  1617. send_sig(SIGPIPE, current, 0);
  1618. goto out_err;
  1619. }
  1620. if ((flags & MSG_TRYHARD) && sk->sk_dst_cache)
  1621. dst_negative_advice(sk);
  1622. mss = scp->segsize_rem;
  1623. fctype = scp->services_rem & NSP_FC_MASK;
  1624. mss = dn_current_mss(sk, flags);
  1625. if (flags & MSG_OOB) {
  1626. queue = &scp->other_xmit_queue;
  1627. if (size > mss) {
  1628. err = -EMSGSIZE;
  1629. goto out;
  1630. }
  1631. }
  1632. scp->persist_fxn = dn_nsp_xmit_timeout;
  1633. while(sent < size) {
  1634. err = sock_error(sk);
  1635. if (err)
  1636. goto out;
  1637. if (signal_pending(current)) {
  1638. err = sock_intr_errno(timeo);
  1639. goto out;
  1640. }
  1641. /*
  1642. * Calculate size that we wish to send.
  1643. */
  1644. len = size - sent;
  1645. if (len > mss)
  1646. len = mss;
  1647. /*
  1648. * Wait for queue size to go down below the window
  1649. * size.
  1650. */
  1651. if (dn_queue_too_long(scp, queue, flags)) {
  1652. DEFINE_WAIT_FUNC(wait, woken_wake_function);
  1653. if (flags & MSG_DONTWAIT) {
  1654. err = -EWOULDBLOCK;
  1655. goto out;
  1656. }
  1657. add_wait_queue(sk_sleep(sk), &wait);
  1658. sk_set_bit(SOCKWQ_ASYNC_WAITDATA, sk);
  1659. sk_wait_event(sk, &timeo,
  1660. !dn_queue_too_long(scp, queue, flags), &wait);
  1661. sk_clear_bit(SOCKWQ_ASYNC_WAITDATA, sk);
  1662. remove_wait_queue(sk_sleep(sk), &wait);
  1663. continue;
  1664. }
  1665. /*
  1666. * Get a suitably sized skb.
  1667. * 64 is a bit of a hack really, but its larger than any
  1668. * link-layer headers and has served us well as a good
  1669. * guess as to their real length.
  1670. */
  1671. skb = dn_alloc_send_pskb(sk, len + 64 + DN_MAX_NSP_DATA_HEADER,
  1672. flags & MSG_DONTWAIT, &err);
  1673. if (err)
  1674. break;
  1675. if (!skb)
  1676. continue;
  1677. cb = DN_SKB_CB(skb);
  1678. skb_reserve(skb, 64 + DN_MAX_NSP_DATA_HEADER);
  1679. if (memcpy_from_msg(skb_put(skb, len), msg, len)) {
  1680. err = -EFAULT;
  1681. goto out;
  1682. }
  1683. if (flags & MSG_OOB) {
  1684. cb->nsp_flags = 0x30;
  1685. if (fctype != NSP_FC_NONE)
  1686. scp->flowrem_oth--;
  1687. } else {
  1688. cb->nsp_flags = 0x00;
  1689. if (scp->seg_total == 0)
  1690. cb->nsp_flags |= 0x20;
  1691. scp->seg_total += len;
  1692. if (((sent + len) == size) && (flags & MSG_EOR)) {
  1693. cb->nsp_flags |= 0x40;
  1694. scp->seg_total = 0;
  1695. if (fctype == NSP_FC_SCMC)
  1696. scp->flowrem_dat--;
  1697. }
  1698. if (fctype == NSP_FC_SRC)
  1699. scp->flowrem_dat--;
  1700. }
  1701. sent += len;
  1702. dn_nsp_queue_xmit(sk, skb, sk->sk_allocation, flags & MSG_OOB);
  1703. skb = NULL;
  1704. scp->persist = dn_nsp_persist(sk);
  1705. }
  1706. out:
  1707. kfree_skb(skb);
  1708. release_sock(sk);
  1709. return sent ? sent : err;
  1710. out_err:
  1711. err = sk_stream_error(sk, flags, err);
  1712. release_sock(sk);
  1713. return err;
  1714. }
  1715. static int dn_device_event(struct notifier_block *this, unsigned long event,
  1716. void *ptr)
  1717. {
  1718. struct net_device *dev = netdev_notifier_info_to_dev(ptr);
  1719. if (!net_eq(dev_net(dev), &init_net))
  1720. return NOTIFY_DONE;
  1721. switch (event) {
  1722. case NETDEV_UP:
  1723. dn_dev_up(dev);
  1724. break;
  1725. case NETDEV_DOWN:
  1726. dn_dev_down(dev);
  1727. break;
  1728. default:
  1729. break;
  1730. }
  1731. return NOTIFY_DONE;
  1732. }
  1733. static struct notifier_block dn_dev_notifier = {
  1734. .notifier_call = dn_device_event,
  1735. };
  1736. static struct packet_type dn_dix_packet_type __read_mostly = {
  1737. .type = cpu_to_be16(ETH_P_DNA_RT),
  1738. .func = dn_route_rcv,
  1739. };
  1740. #ifdef CONFIG_PROC_FS
  1741. struct dn_iter_state {
  1742. int bucket;
  1743. };
  1744. static struct sock *dn_socket_get_first(struct seq_file *seq)
  1745. {
  1746. struct dn_iter_state *state = seq->private;
  1747. struct sock *n = NULL;
  1748. for(state->bucket = 0;
  1749. state->bucket < DN_SK_HASH_SIZE;
  1750. ++state->bucket) {
  1751. n = sk_head(&dn_sk_hash[state->bucket]);
  1752. if (n)
  1753. break;
  1754. }
  1755. return n;
  1756. }
  1757. static struct sock *dn_socket_get_next(struct seq_file *seq,
  1758. struct sock *n)
  1759. {
  1760. struct dn_iter_state *state = seq->private;
  1761. n = sk_next(n);
  1762. try_again:
  1763. if (n)
  1764. goto out;
  1765. if (++state->bucket >= DN_SK_HASH_SIZE)
  1766. goto out;
  1767. n = sk_head(&dn_sk_hash[state->bucket]);
  1768. goto try_again;
  1769. out:
  1770. return n;
  1771. }
  1772. static struct sock *socket_get_idx(struct seq_file *seq, loff_t *pos)
  1773. {
  1774. struct sock *sk = dn_socket_get_first(seq);
  1775. if (sk) {
  1776. while(*pos && (sk = dn_socket_get_next(seq, sk)))
  1777. --*pos;
  1778. }
  1779. return *pos ? NULL : sk;
  1780. }
  1781. static void *dn_socket_get_idx(struct seq_file *seq, loff_t pos)
  1782. {
  1783. void *rc;
  1784. read_lock_bh(&dn_hash_lock);
  1785. rc = socket_get_idx(seq, &pos);
  1786. if (!rc) {
  1787. read_unlock_bh(&dn_hash_lock);
  1788. }
  1789. return rc;
  1790. }
  1791. static void *dn_socket_seq_start(struct seq_file *seq, loff_t *pos)
  1792. {
  1793. return *pos ? dn_socket_get_idx(seq, *pos - 1) : SEQ_START_TOKEN;
  1794. }
  1795. static void *dn_socket_seq_next(struct seq_file *seq, void *v, loff_t *pos)
  1796. {
  1797. void *rc;
  1798. if (v == SEQ_START_TOKEN) {
  1799. rc = dn_socket_get_idx(seq, 0);
  1800. goto out;
  1801. }
  1802. rc = dn_socket_get_next(seq, v);
  1803. if (rc)
  1804. goto out;
  1805. read_unlock_bh(&dn_hash_lock);
  1806. out:
  1807. ++*pos;
  1808. return rc;
  1809. }
  1810. static void dn_socket_seq_stop(struct seq_file *seq, void *v)
  1811. {
  1812. if (v && v != SEQ_START_TOKEN)
  1813. read_unlock_bh(&dn_hash_lock);
  1814. }
  1815. #define IS_NOT_PRINTABLE(x) ((x) < 32 || (x) > 126)
  1816. static void dn_printable_object(struct sockaddr_dn *dn, unsigned char *buf)
  1817. {
  1818. int i;
  1819. switch (le16_to_cpu(dn->sdn_objnamel)) {
  1820. case 0:
  1821. sprintf(buf, "%d", dn->sdn_objnum);
  1822. break;
  1823. default:
  1824. for (i = 0; i < le16_to_cpu(dn->sdn_objnamel); i++) {
  1825. buf[i] = dn->sdn_objname[i];
  1826. if (IS_NOT_PRINTABLE(buf[i]))
  1827. buf[i] = '.';
  1828. }
  1829. buf[i] = 0;
  1830. }
  1831. }
  1832. static char *dn_state2asc(unsigned char state)
  1833. {
  1834. switch (state) {
  1835. case DN_O:
  1836. return "OPEN";
  1837. case DN_CR:
  1838. return " CR";
  1839. case DN_DR:
  1840. return " DR";
  1841. case DN_DRC:
  1842. return " DRC";
  1843. case DN_CC:
  1844. return " CC";
  1845. case DN_CI:
  1846. return " CI";
  1847. case DN_NR:
  1848. return " NR";
  1849. case DN_NC:
  1850. return " NC";
  1851. case DN_CD:
  1852. return " CD";
  1853. case DN_RJ:
  1854. return " RJ";
  1855. case DN_RUN:
  1856. return " RUN";
  1857. case DN_DI:
  1858. return " DI";
  1859. case DN_DIC:
  1860. return " DIC";
  1861. case DN_DN:
  1862. return " DN";
  1863. case DN_CL:
  1864. return " CL";
  1865. case DN_CN:
  1866. return " CN";
  1867. }
  1868. return "????";
  1869. }
  1870. static inline void dn_socket_format_entry(struct seq_file *seq, struct sock *sk)
  1871. {
  1872. struct dn_scp *scp = DN_SK(sk);
  1873. char buf1[DN_ASCBUF_LEN];
  1874. char buf2[DN_ASCBUF_LEN];
  1875. char local_object[DN_MAXOBJL+3];
  1876. char remote_object[DN_MAXOBJL+3];
  1877. dn_printable_object(&scp->addr, local_object);
  1878. dn_printable_object(&scp->peer, remote_object);
  1879. seq_printf(seq,
  1880. "%6s/%04X %04d:%04d %04d:%04d %01d %-16s "
  1881. "%6s/%04X %04d:%04d %04d:%04d %01d %-16s %4s %s\n",
  1882. dn_addr2asc(le16_to_cpu(dn_saddr2dn(&scp->addr)), buf1),
  1883. scp->addrloc,
  1884. scp->numdat,
  1885. scp->numoth,
  1886. scp->ackxmt_dat,
  1887. scp->ackxmt_oth,
  1888. scp->flowloc_sw,
  1889. local_object,
  1890. dn_addr2asc(le16_to_cpu(dn_saddr2dn(&scp->peer)), buf2),
  1891. scp->addrrem,
  1892. scp->numdat_rcv,
  1893. scp->numoth_rcv,
  1894. scp->ackrcv_dat,
  1895. scp->ackrcv_oth,
  1896. scp->flowrem_sw,
  1897. remote_object,
  1898. dn_state2asc(scp->state),
  1899. ((scp->accept_mode == ACC_IMMED) ? "IMMED" : "DEFER"));
  1900. }
  1901. static int dn_socket_seq_show(struct seq_file *seq, void *v)
  1902. {
  1903. if (v == SEQ_START_TOKEN) {
  1904. seq_puts(seq, "Local Remote\n");
  1905. } else {
  1906. dn_socket_format_entry(seq, v);
  1907. }
  1908. return 0;
  1909. }
  1910. static const struct seq_operations dn_socket_seq_ops = {
  1911. .start = dn_socket_seq_start,
  1912. .next = dn_socket_seq_next,
  1913. .stop = dn_socket_seq_stop,
  1914. .show = dn_socket_seq_show,
  1915. };
  1916. static int dn_socket_seq_open(struct inode *inode, struct file *file)
  1917. {
  1918. return seq_open_private(file, &dn_socket_seq_ops,
  1919. sizeof(struct dn_iter_state));
  1920. }
  1921. static const struct file_operations dn_socket_seq_fops = {
  1922. .owner = THIS_MODULE,
  1923. .open = dn_socket_seq_open,
  1924. .read = seq_read,
  1925. .llseek = seq_lseek,
  1926. .release = seq_release_private,
  1927. };
  1928. #endif
  1929. static const struct net_proto_family dn_family_ops = {
  1930. .family = AF_DECnet,
  1931. .create = dn_create,
  1932. .owner = THIS_MODULE,
  1933. };
  1934. static const struct proto_ops dn_proto_ops = {
  1935. .family = AF_DECnet,
  1936. .owner = THIS_MODULE,
  1937. .release = dn_release,
  1938. .bind = dn_bind,
  1939. .connect = dn_connect,
  1940. .socketpair = sock_no_socketpair,
  1941. .accept = dn_accept,
  1942. .getname = dn_getname,
  1943. .poll = dn_poll,
  1944. .ioctl = dn_ioctl,
  1945. .listen = dn_listen,
  1946. .shutdown = dn_shutdown,
  1947. .setsockopt = dn_setsockopt,
  1948. .getsockopt = dn_getsockopt,
  1949. .sendmsg = dn_sendmsg,
  1950. .recvmsg = dn_recvmsg,
  1951. .mmap = sock_no_mmap,
  1952. .sendpage = sock_no_sendpage,
  1953. };
  1954. MODULE_DESCRIPTION("The Linux DECnet Network Protocol");
  1955. MODULE_AUTHOR("Linux DECnet Project Team");
  1956. MODULE_LICENSE("GPL");
  1957. MODULE_ALIAS_NETPROTO(PF_DECnet);
  1958. static const char banner[] __initconst = KERN_INFO
  1959. "NET4: DECnet for Linux: V.2.5.68s (C) 1995-2003 Linux DECnet Project Team\n";
  1960. static int __init decnet_init(void)
  1961. {
  1962. int rc;
  1963. printk(banner);
  1964. rc = proto_register(&dn_proto, 1);
  1965. if (rc != 0)
  1966. goto out;
  1967. dn_neigh_init();
  1968. dn_dev_init();
  1969. dn_route_init();
  1970. dn_fib_init();
  1971. sock_register(&dn_family_ops);
  1972. dev_add_pack(&dn_dix_packet_type);
  1973. register_netdevice_notifier(&dn_dev_notifier);
  1974. proc_create("decnet", S_IRUGO, init_net.proc_net, &dn_socket_seq_fops);
  1975. dn_register_sysctl();
  1976. out:
  1977. return rc;
  1978. }
  1979. module_init(decnet_init);
  1980. /*
  1981. * Prevent DECnet module unloading until its fixed properly.
  1982. * Requires an audit of the code to check for memory leaks and
  1983. * initialisation problems etc.
  1984. */
  1985. #if 0
  1986. static void __exit decnet_exit(void)
  1987. {
  1988. sock_unregister(AF_DECnet);
  1989. rtnl_unregister_all(PF_DECnet);
  1990. dev_remove_pack(&dn_dix_packet_type);
  1991. dn_unregister_sysctl();
  1992. unregister_netdevice_notifier(&dn_dev_notifier);
  1993. dn_route_cleanup();
  1994. dn_dev_cleanup();
  1995. dn_neigh_cleanup();
  1996. dn_fib_cleanup();
  1997. remove_proc_entry("decnet", init_net.proc_net);
  1998. proto_unregister(&dn_proto);
  1999. rcu_barrier_bh(); /* Wait for completion of call_rcu_bh()'s */
  2000. }
  2001. module_exit(decnet_exit);
  2002. #endif