vmci_transport.c 58 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153
  1. /*
  2. * VMware vSockets Driver
  3. *
  4. * Copyright (C) 2007-2013 VMware, Inc. All rights reserved.
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of the GNU General Public License as published by the Free
  8. * Software Foundation version 2 and no later version.
  9. *
  10. * This program is distributed in the hope that it will be useful, but WITHOUT
  11. * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  12. * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  13. * more details.
  14. */
  15. #include <linux/types.h>
  16. #include <linux/bitops.h>
  17. #include <linux/cred.h>
  18. #include <linux/init.h>
  19. #include <linux/io.h>
  20. #include <linux/kernel.h>
  21. #include <linux/kmod.h>
  22. #include <linux/list.h>
  23. #include <linux/module.h>
  24. #include <linux/mutex.h>
  25. #include <linux/net.h>
  26. #include <linux/poll.h>
  27. #include <linux/skbuff.h>
  28. #include <linux/smp.h>
  29. #include <linux/socket.h>
  30. #include <linux/stddef.h>
  31. #include <linux/unistd.h>
  32. #include <linux/wait.h>
  33. #include <linux/workqueue.h>
  34. #include <net/sock.h>
  35. #include <net/af_vsock.h>
  36. #include "vmci_transport_notify.h"
  37. static int vmci_transport_recv_dgram_cb(void *data, struct vmci_datagram *dg);
  38. static int vmci_transport_recv_stream_cb(void *data, struct vmci_datagram *dg);
  39. static void vmci_transport_peer_detach_cb(u32 sub_id,
  40. const struct vmci_event_data *ed,
  41. void *client_data);
  42. static void vmci_transport_recv_pkt_work(struct work_struct *work);
  43. static void vmci_transport_cleanup(struct work_struct *work);
  44. static int vmci_transport_recv_listen(struct sock *sk,
  45. struct vmci_transport_packet *pkt);
  46. static int vmci_transport_recv_connecting_server(
  47. struct sock *sk,
  48. struct sock *pending,
  49. struct vmci_transport_packet *pkt);
  50. static int vmci_transport_recv_connecting_client(
  51. struct sock *sk,
  52. struct vmci_transport_packet *pkt);
  53. static int vmci_transport_recv_connecting_client_negotiate(
  54. struct sock *sk,
  55. struct vmci_transport_packet *pkt);
  56. static int vmci_transport_recv_connecting_client_invalid(
  57. struct sock *sk,
  58. struct vmci_transport_packet *pkt);
  59. static int vmci_transport_recv_connected(struct sock *sk,
  60. struct vmci_transport_packet *pkt);
  61. static bool vmci_transport_old_proto_override(bool *old_pkt_proto);
  62. static u16 vmci_transport_new_proto_supported_versions(void);
  63. static bool vmci_transport_proto_to_notify_struct(struct sock *sk, u16 *proto,
  64. bool old_pkt_proto);
  65. struct vmci_transport_recv_pkt_info {
  66. struct work_struct work;
  67. struct sock *sk;
  68. struct vmci_transport_packet pkt;
  69. };
  70. static LIST_HEAD(vmci_transport_cleanup_list);
  71. static DEFINE_SPINLOCK(vmci_transport_cleanup_lock);
  72. static DECLARE_WORK(vmci_transport_cleanup_work, vmci_transport_cleanup);
  73. static struct vmci_handle vmci_transport_stream_handle = { VMCI_INVALID_ID,
  74. VMCI_INVALID_ID };
  75. static u32 vmci_transport_qp_resumed_sub_id = VMCI_INVALID_ID;
  76. static int PROTOCOL_OVERRIDE = -1;
  77. #define VMCI_TRANSPORT_DEFAULT_QP_SIZE_MIN 128
  78. #define VMCI_TRANSPORT_DEFAULT_QP_SIZE 262144
  79. #define VMCI_TRANSPORT_DEFAULT_QP_SIZE_MAX 262144
  80. /* The default peer timeout indicates how long we will wait for a peer response
  81. * to a control message.
  82. */
  83. #define VSOCK_DEFAULT_CONNECT_TIMEOUT (2 * HZ)
  84. /* Helper function to convert from a VMCI error code to a VSock error code. */
  85. static s32 vmci_transport_error_to_vsock_error(s32 vmci_error)
  86. {
  87. switch (vmci_error) {
  88. case VMCI_ERROR_NO_MEM:
  89. return -ENOMEM;
  90. case VMCI_ERROR_DUPLICATE_ENTRY:
  91. case VMCI_ERROR_ALREADY_EXISTS:
  92. return -EADDRINUSE;
  93. case VMCI_ERROR_NO_ACCESS:
  94. return -EPERM;
  95. case VMCI_ERROR_NO_RESOURCES:
  96. return -ENOBUFS;
  97. case VMCI_ERROR_INVALID_RESOURCE:
  98. return -EHOSTUNREACH;
  99. case VMCI_ERROR_INVALID_ARGS:
  100. default:
  101. break;
  102. }
  103. return -EINVAL;
  104. }
  105. static u32 vmci_transport_peer_rid(u32 peer_cid)
  106. {
  107. if (VMADDR_CID_HYPERVISOR == peer_cid)
  108. return VMCI_TRANSPORT_HYPERVISOR_PACKET_RID;
  109. return VMCI_TRANSPORT_PACKET_RID;
  110. }
  111. static inline void
  112. vmci_transport_packet_init(struct vmci_transport_packet *pkt,
  113. struct sockaddr_vm *src,
  114. struct sockaddr_vm *dst,
  115. u8 type,
  116. u64 size,
  117. u64 mode,
  118. struct vmci_transport_waiting_info *wait,
  119. u16 proto,
  120. struct vmci_handle handle)
  121. {
  122. /* We register the stream control handler as an any cid handle so we
  123. * must always send from a source address of VMADDR_CID_ANY
  124. */
  125. pkt->dg.src = vmci_make_handle(VMADDR_CID_ANY,
  126. VMCI_TRANSPORT_PACKET_RID);
  127. pkt->dg.dst = vmci_make_handle(dst->svm_cid,
  128. vmci_transport_peer_rid(dst->svm_cid));
  129. pkt->dg.payload_size = sizeof(*pkt) - sizeof(pkt->dg);
  130. pkt->version = VMCI_TRANSPORT_PACKET_VERSION;
  131. pkt->type = type;
  132. pkt->src_port = src->svm_port;
  133. pkt->dst_port = dst->svm_port;
  134. memset(&pkt->proto, 0, sizeof(pkt->proto));
  135. memset(&pkt->_reserved2, 0, sizeof(pkt->_reserved2));
  136. switch (pkt->type) {
  137. case VMCI_TRANSPORT_PACKET_TYPE_INVALID:
  138. pkt->u.size = 0;
  139. break;
  140. case VMCI_TRANSPORT_PACKET_TYPE_REQUEST:
  141. case VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE:
  142. pkt->u.size = size;
  143. break;
  144. case VMCI_TRANSPORT_PACKET_TYPE_OFFER:
  145. case VMCI_TRANSPORT_PACKET_TYPE_ATTACH:
  146. pkt->u.handle = handle;
  147. break;
  148. case VMCI_TRANSPORT_PACKET_TYPE_WROTE:
  149. case VMCI_TRANSPORT_PACKET_TYPE_READ:
  150. case VMCI_TRANSPORT_PACKET_TYPE_RST:
  151. pkt->u.size = 0;
  152. break;
  153. case VMCI_TRANSPORT_PACKET_TYPE_SHUTDOWN:
  154. pkt->u.mode = mode;
  155. break;
  156. case VMCI_TRANSPORT_PACKET_TYPE_WAITING_READ:
  157. case VMCI_TRANSPORT_PACKET_TYPE_WAITING_WRITE:
  158. memcpy(&pkt->u.wait, wait, sizeof(pkt->u.wait));
  159. break;
  160. case VMCI_TRANSPORT_PACKET_TYPE_REQUEST2:
  161. case VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE2:
  162. pkt->u.size = size;
  163. pkt->proto = proto;
  164. break;
  165. }
  166. }
  167. static inline void
  168. vmci_transport_packet_get_addresses(struct vmci_transport_packet *pkt,
  169. struct sockaddr_vm *local,
  170. struct sockaddr_vm *remote)
  171. {
  172. vsock_addr_init(local, pkt->dg.dst.context, pkt->dst_port);
  173. vsock_addr_init(remote, pkt->dg.src.context, pkt->src_port);
  174. }
  175. static int
  176. __vmci_transport_send_control_pkt(struct vmci_transport_packet *pkt,
  177. struct sockaddr_vm *src,
  178. struct sockaddr_vm *dst,
  179. enum vmci_transport_packet_type type,
  180. u64 size,
  181. u64 mode,
  182. struct vmci_transport_waiting_info *wait,
  183. u16 proto,
  184. struct vmci_handle handle,
  185. bool convert_error)
  186. {
  187. int err;
  188. vmci_transport_packet_init(pkt, src, dst, type, size, mode, wait,
  189. proto, handle);
  190. err = vmci_datagram_send(&pkt->dg);
  191. if (convert_error && (err < 0))
  192. return vmci_transport_error_to_vsock_error(err);
  193. return err;
  194. }
  195. static int
  196. vmci_transport_reply_control_pkt_fast(struct vmci_transport_packet *pkt,
  197. enum vmci_transport_packet_type type,
  198. u64 size,
  199. u64 mode,
  200. struct vmci_transport_waiting_info *wait,
  201. struct vmci_handle handle)
  202. {
  203. struct vmci_transport_packet reply;
  204. struct sockaddr_vm src, dst;
  205. if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_RST) {
  206. return 0;
  207. } else {
  208. vmci_transport_packet_get_addresses(pkt, &src, &dst);
  209. return __vmci_transport_send_control_pkt(&reply, &src, &dst,
  210. type,
  211. size, mode, wait,
  212. VSOCK_PROTO_INVALID,
  213. handle, true);
  214. }
  215. }
  216. static int
  217. vmci_transport_send_control_pkt_bh(struct sockaddr_vm *src,
  218. struct sockaddr_vm *dst,
  219. enum vmci_transport_packet_type type,
  220. u64 size,
  221. u64 mode,
  222. struct vmci_transport_waiting_info *wait,
  223. struct vmci_handle handle)
  224. {
  225. /* Note that it is safe to use a single packet across all CPUs since
  226. * two tasklets of the same type are guaranteed to not ever run
  227. * simultaneously. If that ever changes, or VMCI stops using tasklets,
  228. * we can use per-cpu packets.
  229. */
  230. static struct vmci_transport_packet pkt;
  231. return __vmci_transport_send_control_pkt(&pkt, src, dst, type,
  232. size, mode, wait,
  233. VSOCK_PROTO_INVALID, handle,
  234. false);
  235. }
  236. static int
  237. vmci_transport_send_control_pkt(struct sock *sk,
  238. enum vmci_transport_packet_type type,
  239. u64 size,
  240. u64 mode,
  241. struct vmci_transport_waiting_info *wait,
  242. u16 proto,
  243. struct vmci_handle handle)
  244. {
  245. struct vmci_transport_packet *pkt;
  246. struct vsock_sock *vsk;
  247. int err;
  248. vsk = vsock_sk(sk);
  249. if (!vsock_addr_bound(&vsk->local_addr))
  250. return -EINVAL;
  251. if (!vsock_addr_bound(&vsk->remote_addr))
  252. return -EINVAL;
  253. pkt = kmalloc(sizeof(*pkt), GFP_KERNEL);
  254. if (!pkt)
  255. return -ENOMEM;
  256. err = __vmci_transport_send_control_pkt(pkt, &vsk->local_addr,
  257. &vsk->remote_addr, type, size,
  258. mode, wait, proto, handle,
  259. true);
  260. kfree(pkt);
  261. return err;
  262. }
  263. static int vmci_transport_send_reset_bh(struct sockaddr_vm *dst,
  264. struct sockaddr_vm *src,
  265. struct vmci_transport_packet *pkt)
  266. {
  267. if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_RST)
  268. return 0;
  269. return vmci_transport_send_control_pkt_bh(
  270. dst, src,
  271. VMCI_TRANSPORT_PACKET_TYPE_RST, 0,
  272. 0, NULL, VMCI_INVALID_HANDLE);
  273. }
  274. static int vmci_transport_send_reset(struct sock *sk,
  275. struct vmci_transport_packet *pkt)
  276. {
  277. if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_RST)
  278. return 0;
  279. return vmci_transport_send_control_pkt(sk,
  280. VMCI_TRANSPORT_PACKET_TYPE_RST,
  281. 0, 0, NULL, VSOCK_PROTO_INVALID,
  282. VMCI_INVALID_HANDLE);
  283. }
  284. static int vmci_transport_send_negotiate(struct sock *sk, size_t size)
  285. {
  286. return vmci_transport_send_control_pkt(
  287. sk,
  288. VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE,
  289. size, 0, NULL,
  290. VSOCK_PROTO_INVALID,
  291. VMCI_INVALID_HANDLE);
  292. }
  293. static int vmci_transport_send_negotiate2(struct sock *sk, size_t size,
  294. u16 version)
  295. {
  296. return vmci_transport_send_control_pkt(
  297. sk,
  298. VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE2,
  299. size, 0, NULL, version,
  300. VMCI_INVALID_HANDLE);
  301. }
  302. static int vmci_transport_send_qp_offer(struct sock *sk,
  303. struct vmci_handle handle)
  304. {
  305. return vmci_transport_send_control_pkt(
  306. sk, VMCI_TRANSPORT_PACKET_TYPE_OFFER, 0,
  307. 0, NULL,
  308. VSOCK_PROTO_INVALID, handle);
  309. }
  310. static int vmci_transport_send_attach(struct sock *sk,
  311. struct vmci_handle handle)
  312. {
  313. return vmci_transport_send_control_pkt(
  314. sk, VMCI_TRANSPORT_PACKET_TYPE_ATTACH,
  315. 0, 0, NULL, VSOCK_PROTO_INVALID,
  316. handle);
  317. }
  318. static int vmci_transport_reply_reset(struct vmci_transport_packet *pkt)
  319. {
  320. return vmci_transport_reply_control_pkt_fast(
  321. pkt,
  322. VMCI_TRANSPORT_PACKET_TYPE_RST,
  323. 0, 0, NULL,
  324. VMCI_INVALID_HANDLE);
  325. }
  326. static int vmci_transport_send_invalid_bh(struct sockaddr_vm *dst,
  327. struct sockaddr_vm *src)
  328. {
  329. return vmci_transport_send_control_pkt_bh(
  330. dst, src,
  331. VMCI_TRANSPORT_PACKET_TYPE_INVALID,
  332. 0, 0, NULL, VMCI_INVALID_HANDLE);
  333. }
  334. int vmci_transport_send_wrote_bh(struct sockaddr_vm *dst,
  335. struct sockaddr_vm *src)
  336. {
  337. return vmci_transport_send_control_pkt_bh(
  338. dst, src,
  339. VMCI_TRANSPORT_PACKET_TYPE_WROTE, 0,
  340. 0, NULL, VMCI_INVALID_HANDLE);
  341. }
  342. int vmci_transport_send_read_bh(struct sockaddr_vm *dst,
  343. struct sockaddr_vm *src)
  344. {
  345. return vmci_transport_send_control_pkt_bh(
  346. dst, src,
  347. VMCI_TRANSPORT_PACKET_TYPE_READ, 0,
  348. 0, NULL, VMCI_INVALID_HANDLE);
  349. }
  350. int vmci_transport_send_wrote(struct sock *sk)
  351. {
  352. return vmci_transport_send_control_pkt(
  353. sk, VMCI_TRANSPORT_PACKET_TYPE_WROTE, 0,
  354. 0, NULL, VSOCK_PROTO_INVALID,
  355. VMCI_INVALID_HANDLE);
  356. }
  357. int vmci_transport_send_read(struct sock *sk)
  358. {
  359. return vmci_transport_send_control_pkt(
  360. sk, VMCI_TRANSPORT_PACKET_TYPE_READ, 0,
  361. 0, NULL, VSOCK_PROTO_INVALID,
  362. VMCI_INVALID_HANDLE);
  363. }
  364. int vmci_transport_send_waiting_write(struct sock *sk,
  365. struct vmci_transport_waiting_info *wait)
  366. {
  367. return vmci_transport_send_control_pkt(
  368. sk, VMCI_TRANSPORT_PACKET_TYPE_WAITING_WRITE,
  369. 0, 0, wait, VSOCK_PROTO_INVALID,
  370. VMCI_INVALID_HANDLE);
  371. }
  372. int vmci_transport_send_waiting_read(struct sock *sk,
  373. struct vmci_transport_waiting_info *wait)
  374. {
  375. return vmci_transport_send_control_pkt(
  376. sk, VMCI_TRANSPORT_PACKET_TYPE_WAITING_READ,
  377. 0, 0, wait, VSOCK_PROTO_INVALID,
  378. VMCI_INVALID_HANDLE);
  379. }
  380. static int vmci_transport_shutdown(struct vsock_sock *vsk, int mode)
  381. {
  382. return vmci_transport_send_control_pkt(
  383. &vsk->sk,
  384. VMCI_TRANSPORT_PACKET_TYPE_SHUTDOWN,
  385. 0, mode, NULL,
  386. VSOCK_PROTO_INVALID,
  387. VMCI_INVALID_HANDLE);
  388. }
  389. static int vmci_transport_send_conn_request(struct sock *sk, size_t size)
  390. {
  391. return vmci_transport_send_control_pkt(sk,
  392. VMCI_TRANSPORT_PACKET_TYPE_REQUEST,
  393. size, 0, NULL,
  394. VSOCK_PROTO_INVALID,
  395. VMCI_INVALID_HANDLE);
  396. }
  397. static int vmci_transport_send_conn_request2(struct sock *sk, size_t size,
  398. u16 version)
  399. {
  400. return vmci_transport_send_control_pkt(
  401. sk, VMCI_TRANSPORT_PACKET_TYPE_REQUEST2,
  402. size, 0, NULL, version,
  403. VMCI_INVALID_HANDLE);
  404. }
  405. static struct sock *vmci_transport_get_pending(
  406. struct sock *listener,
  407. struct vmci_transport_packet *pkt)
  408. {
  409. struct vsock_sock *vlistener;
  410. struct vsock_sock *vpending;
  411. struct sock *pending;
  412. struct sockaddr_vm src;
  413. vsock_addr_init(&src, pkt->dg.src.context, pkt->src_port);
  414. vlistener = vsock_sk(listener);
  415. list_for_each_entry(vpending, &vlistener->pending_links,
  416. pending_links) {
  417. if (vsock_addr_equals_addr(&src, &vpending->remote_addr) &&
  418. pkt->dst_port == vpending->local_addr.svm_port) {
  419. pending = sk_vsock(vpending);
  420. sock_hold(pending);
  421. goto found;
  422. }
  423. }
  424. pending = NULL;
  425. found:
  426. return pending;
  427. }
  428. static void vmci_transport_release_pending(struct sock *pending)
  429. {
  430. sock_put(pending);
  431. }
  432. /* We allow two kinds of sockets to communicate with a restricted VM: 1)
  433. * trusted sockets 2) sockets from applications running as the same user as the
  434. * VM (this is only true for the host side and only when using hosted products)
  435. */
  436. static bool vmci_transport_is_trusted(struct vsock_sock *vsock, u32 peer_cid)
  437. {
  438. return vsock->trusted ||
  439. vmci_is_context_owner(peer_cid, vsock->owner->uid);
  440. }
  441. /* We allow sending datagrams to and receiving datagrams from a restricted VM
  442. * only if it is trusted as described in vmci_transport_is_trusted.
  443. */
  444. static bool vmci_transport_allow_dgram(struct vsock_sock *vsock, u32 peer_cid)
  445. {
  446. if (VMADDR_CID_HYPERVISOR == peer_cid)
  447. return true;
  448. if (vsock->cached_peer != peer_cid) {
  449. vsock->cached_peer = peer_cid;
  450. if (!vmci_transport_is_trusted(vsock, peer_cid) &&
  451. (vmci_context_get_priv_flags(peer_cid) &
  452. VMCI_PRIVILEGE_FLAG_RESTRICTED)) {
  453. vsock->cached_peer_allow_dgram = false;
  454. } else {
  455. vsock->cached_peer_allow_dgram = true;
  456. }
  457. }
  458. return vsock->cached_peer_allow_dgram;
  459. }
  460. static int
  461. vmci_transport_queue_pair_alloc(struct vmci_qp **qpair,
  462. struct vmci_handle *handle,
  463. u64 produce_size,
  464. u64 consume_size,
  465. u32 peer, u32 flags, bool trusted)
  466. {
  467. int err = 0;
  468. if (trusted) {
  469. /* Try to allocate our queue pair as trusted. This will only
  470. * work if vsock is running in the host.
  471. */
  472. err = vmci_qpair_alloc(qpair, handle, produce_size,
  473. consume_size,
  474. peer, flags,
  475. VMCI_PRIVILEGE_FLAG_TRUSTED);
  476. if (err != VMCI_ERROR_NO_ACCESS)
  477. goto out;
  478. }
  479. err = vmci_qpair_alloc(qpair, handle, produce_size, consume_size,
  480. peer, flags, VMCI_NO_PRIVILEGE_FLAGS);
  481. out:
  482. if (err < 0) {
  483. pr_err("Could not attach to queue pair with %d\n",
  484. err);
  485. err = vmci_transport_error_to_vsock_error(err);
  486. }
  487. return err;
  488. }
  489. static int
  490. vmci_transport_datagram_create_hnd(u32 resource_id,
  491. u32 flags,
  492. vmci_datagram_recv_cb recv_cb,
  493. void *client_data,
  494. struct vmci_handle *out_handle)
  495. {
  496. int err = 0;
  497. /* Try to allocate our datagram handler as trusted. This will only work
  498. * if vsock is running in the host.
  499. */
  500. err = vmci_datagram_create_handle_priv(resource_id, flags,
  501. VMCI_PRIVILEGE_FLAG_TRUSTED,
  502. recv_cb,
  503. client_data, out_handle);
  504. if (err == VMCI_ERROR_NO_ACCESS)
  505. err = vmci_datagram_create_handle(resource_id, flags,
  506. recv_cb, client_data,
  507. out_handle);
  508. return err;
  509. }
  510. /* This is invoked as part of a tasklet that's scheduled when the VMCI
  511. * interrupt fires. This is run in bottom-half context and if it ever needs to
  512. * sleep it should defer that work to a work queue.
  513. */
  514. static int vmci_transport_recv_dgram_cb(void *data, struct vmci_datagram *dg)
  515. {
  516. struct sock *sk;
  517. size_t size;
  518. struct sk_buff *skb;
  519. struct vsock_sock *vsk;
  520. sk = (struct sock *)data;
  521. /* This handler is privileged when this module is running on the host.
  522. * We will get datagrams from all endpoints (even VMs that are in a
  523. * restricted context). If we get one from a restricted context then
  524. * the destination socket must be trusted.
  525. *
  526. * NOTE: We access the socket struct without holding the lock here.
  527. * This is ok because the field we are interested is never modified
  528. * outside of the create and destruct socket functions.
  529. */
  530. vsk = vsock_sk(sk);
  531. if (!vmci_transport_allow_dgram(vsk, dg->src.context))
  532. return VMCI_ERROR_NO_ACCESS;
  533. size = VMCI_DG_SIZE(dg);
  534. /* Attach the packet to the socket's receive queue as an sk_buff. */
  535. skb = alloc_skb(size, GFP_ATOMIC);
  536. if (!skb)
  537. return VMCI_ERROR_NO_MEM;
  538. /* sk_receive_skb() will do a sock_put(), so hold here. */
  539. sock_hold(sk);
  540. skb_put(skb, size);
  541. memcpy(skb->data, dg, size);
  542. sk_receive_skb(sk, skb, 0);
  543. return VMCI_SUCCESS;
  544. }
  545. static bool vmci_transport_stream_allow(u32 cid, u32 port)
  546. {
  547. static const u32 non_socket_contexts[] = {
  548. VMADDR_CID_RESERVED,
  549. };
  550. int i;
  551. BUILD_BUG_ON(sizeof(cid) != sizeof(*non_socket_contexts));
  552. for (i = 0; i < ARRAY_SIZE(non_socket_contexts); i++) {
  553. if (cid == non_socket_contexts[i])
  554. return false;
  555. }
  556. return true;
  557. }
  558. /* This is invoked as part of a tasklet that's scheduled when the VMCI
  559. * interrupt fires. This is run in bottom-half context but it defers most of
  560. * its work to the packet handling work queue.
  561. */
  562. static int vmci_transport_recv_stream_cb(void *data, struct vmci_datagram *dg)
  563. {
  564. struct sock *sk;
  565. struct sockaddr_vm dst;
  566. struct sockaddr_vm src;
  567. struct vmci_transport_packet *pkt;
  568. struct vsock_sock *vsk;
  569. bool bh_process_pkt;
  570. int err;
  571. sk = NULL;
  572. err = VMCI_SUCCESS;
  573. bh_process_pkt = false;
  574. /* Ignore incoming packets from contexts without sockets, or resources
  575. * that aren't vsock implementations.
  576. */
  577. if (!vmci_transport_stream_allow(dg->src.context, -1)
  578. || vmci_transport_peer_rid(dg->src.context) != dg->src.resource)
  579. return VMCI_ERROR_NO_ACCESS;
  580. if (VMCI_DG_SIZE(dg) < sizeof(*pkt))
  581. /* Drop datagrams that do not contain full VSock packets. */
  582. return VMCI_ERROR_INVALID_ARGS;
  583. pkt = (struct vmci_transport_packet *)dg;
  584. /* Find the socket that should handle this packet. First we look for a
  585. * connected socket and if there is none we look for a socket bound to
  586. * the destintation address.
  587. */
  588. vsock_addr_init(&src, pkt->dg.src.context, pkt->src_port);
  589. vsock_addr_init(&dst, pkt->dg.dst.context, pkt->dst_port);
  590. sk = vsock_find_connected_socket(&src, &dst);
  591. if (!sk) {
  592. sk = vsock_find_bound_socket(&dst);
  593. if (!sk) {
  594. /* We could not find a socket for this specified
  595. * address. If this packet is a RST, we just drop it.
  596. * If it is another packet, we send a RST. Note that
  597. * we do not send a RST reply to RSTs so that we do not
  598. * continually send RSTs between two endpoints.
  599. *
  600. * Note that since this is a reply, dst is src and src
  601. * is dst.
  602. */
  603. if (vmci_transport_send_reset_bh(&dst, &src, pkt) < 0)
  604. pr_err("unable to send reset\n");
  605. err = VMCI_ERROR_NOT_FOUND;
  606. goto out;
  607. }
  608. }
  609. /* If the received packet type is beyond all types known to this
  610. * implementation, reply with an invalid message. Hopefully this will
  611. * help when implementing backwards compatibility in the future.
  612. */
  613. if (pkt->type >= VMCI_TRANSPORT_PACKET_TYPE_MAX) {
  614. vmci_transport_send_invalid_bh(&dst, &src);
  615. err = VMCI_ERROR_INVALID_ARGS;
  616. goto out;
  617. }
  618. /* This handler is privileged when this module is running on the host.
  619. * We will get datagram connect requests from all endpoints (even VMs
  620. * that are in a restricted context). If we get one from a restricted
  621. * context then the destination socket must be trusted.
  622. *
  623. * NOTE: We access the socket struct without holding the lock here.
  624. * This is ok because the field we are interested is never modified
  625. * outside of the create and destruct socket functions.
  626. */
  627. vsk = vsock_sk(sk);
  628. if (!vmci_transport_allow_dgram(vsk, pkt->dg.src.context)) {
  629. err = VMCI_ERROR_NO_ACCESS;
  630. goto out;
  631. }
  632. /* We do most everything in a work queue, but let's fast path the
  633. * notification of reads and writes to help data transfer performance.
  634. * We can only do this if there is no process context code executing
  635. * for this socket since that may change the state.
  636. */
  637. bh_lock_sock(sk);
  638. if (!sock_owned_by_user(sk)) {
  639. /* The local context ID may be out of date, update it. */
  640. vsk->local_addr.svm_cid = dst.svm_cid;
  641. if (sk->sk_state == TCP_ESTABLISHED)
  642. vmci_trans(vsk)->notify_ops->handle_notify_pkt(
  643. sk, pkt, true, &dst, &src,
  644. &bh_process_pkt);
  645. }
  646. bh_unlock_sock(sk);
  647. if (!bh_process_pkt) {
  648. struct vmci_transport_recv_pkt_info *recv_pkt_info;
  649. recv_pkt_info = kmalloc(sizeof(*recv_pkt_info), GFP_ATOMIC);
  650. if (!recv_pkt_info) {
  651. if (vmci_transport_send_reset_bh(&dst, &src, pkt) < 0)
  652. pr_err("unable to send reset\n");
  653. err = VMCI_ERROR_NO_MEM;
  654. goto out;
  655. }
  656. recv_pkt_info->sk = sk;
  657. memcpy(&recv_pkt_info->pkt, pkt, sizeof(recv_pkt_info->pkt));
  658. INIT_WORK(&recv_pkt_info->work, vmci_transport_recv_pkt_work);
  659. schedule_work(&recv_pkt_info->work);
  660. /* Clear sk so that the reference count incremented by one of
  661. * the Find functions above is not decremented below. We need
  662. * that reference count for the packet handler we've scheduled
  663. * to run.
  664. */
  665. sk = NULL;
  666. }
  667. out:
  668. if (sk)
  669. sock_put(sk);
  670. return err;
  671. }
  672. static void vmci_transport_handle_detach(struct sock *sk)
  673. {
  674. struct vsock_sock *vsk;
  675. vsk = vsock_sk(sk);
  676. if (!vmci_handle_is_invalid(vmci_trans(vsk)->qp_handle)) {
  677. sock_set_flag(sk, SOCK_DONE);
  678. /* On a detach the peer will not be sending or receiving
  679. * anymore.
  680. */
  681. vsk->peer_shutdown = SHUTDOWN_MASK;
  682. /* We should not be sending anymore since the peer won't be
  683. * there to receive, but we can still receive if there is data
  684. * left in our consume queue. If the local endpoint is a host,
  685. * we can't call vsock_stream_has_data, since that may block,
  686. * but a host endpoint can't read data once the VM has
  687. * detached, so there is no available data in that case.
  688. */
  689. if (vsk->local_addr.svm_cid == VMADDR_CID_HOST ||
  690. vsock_stream_has_data(vsk) <= 0) {
  691. if (sk->sk_state == TCP_SYN_SENT) {
  692. /* The peer may detach from a queue pair while
  693. * we are still in the connecting state, i.e.,
  694. * if the peer VM is killed after attaching to
  695. * a queue pair, but before we complete the
  696. * handshake. In that case, we treat the detach
  697. * event like a reset.
  698. */
  699. sk->sk_state = TCP_CLOSE;
  700. sk->sk_err = ECONNRESET;
  701. sk->sk_error_report(sk);
  702. return;
  703. }
  704. sk->sk_state = TCP_CLOSE;
  705. }
  706. sk->sk_state_change(sk);
  707. }
  708. }
  709. static void vmci_transport_peer_detach_cb(u32 sub_id,
  710. const struct vmci_event_data *e_data,
  711. void *client_data)
  712. {
  713. struct vmci_transport *trans = client_data;
  714. const struct vmci_event_payload_qp *e_payload;
  715. e_payload = vmci_event_data_const_payload(e_data);
  716. /* XXX This is lame, we should provide a way to lookup sockets by
  717. * qp_handle.
  718. */
  719. if (vmci_handle_is_invalid(e_payload->handle) ||
  720. !vmci_handle_is_equal(trans->qp_handle, e_payload->handle))
  721. return;
  722. /* We don't ask for delayed CBs when we subscribe to this event (we
  723. * pass 0 as flags to vmci_event_subscribe()). VMCI makes no
  724. * guarantees in that case about what context we might be running in,
  725. * so it could be BH or process, blockable or non-blockable. So we
  726. * need to account for all possible contexts here.
  727. */
  728. spin_lock_bh(&trans->lock);
  729. if (!trans->sk)
  730. goto out;
  731. /* Apart from here, trans->lock is only grabbed as part of sk destruct,
  732. * where trans->sk isn't locked.
  733. */
  734. bh_lock_sock(trans->sk);
  735. vmci_transport_handle_detach(trans->sk);
  736. bh_unlock_sock(trans->sk);
  737. out:
  738. spin_unlock_bh(&trans->lock);
  739. }
  740. static void vmci_transport_qp_resumed_cb(u32 sub_id,
  741. const struct vmci_event_data *e_data,
  742. void *client_data)
  743. {
  744. vsock_for_each_connected_socket(vmci_transport_handle_detach);
  745. }
  746. static void vmci_transport_recv_pkt_work(struct work_struct *work)
  747. {
  748. struct vmci_transport_recv_pkt_info *recv_pkt_info;
  749. struct vmci_transport_packet *pkt;
  750. struct sock *sk;
  751. recv_pkt_info =
  752. container_of(work, struct vmci_transport_recv_pkt_info, work);
  753. sk = recv_pkt_info->sk;
  754. pkt = &recv_pkt_info->pkt;
  755. lock_sock(sk);
  756. /* The local context ID may be out of date. */
  757. vsock_sk(sk)->local_addr.svm_cid = pkt->dg.dst.context;
  758. switch (sk->sk_state) {
  759. case TCP_LISTEN:
  760. vmci_transport_recv_listen(sk, pkt);
  761. break;
  762. case TCP_SYN_SENT:
  763. /* Processing of pending connections for servers goes through
  764. * the listening socket, so see vmci_transport_recv_listen()
  765. * for that path.
  766. */
  767. vmci_transport_recv_connecting_client(sk, pkt);
  768. break;
  769. case TCP_ESTABLISHED:
  770. vmci_transport_recv_connected(sk, pkt);
  771. break;
  772. default:
  773. /* Because this function does not run in the same context as
  774. * vmci_transport_recv_stream_cb it is possible that the
  775. * socket has closed. We need to let the other side know or it
  776. * could be sitting in a connect and hang forever. Send a
  777. * reset to prevent that.
  778. */
  779. vmci_transport_send_reset(sk, pkt);
  780. break;
  781. }
  782. release_sock(sk);
  783. kfree(recv_pkt_info);
  784. /* Release reference obtained in the stream callback when we fetched
  785. * this socket out of the bound or connected list.
  786. */
  787. sock_put(sk);
  788. }
  789. static int vmci_transport_recv_listen(struct sock *sk,
  790. struct vmci_transport_packet *pkt)
  791. {
  792. struct sock *pending;
  793. struct vsock_sock *vpending;
  794. int err;
  795. u64 qp_size;
  796. bool old_request = false;
  797. bool old_pkt_proto = false;
  798. err = 0;
  799. /* Because we are in the listen state, we could be receiving a packet
  800. * for ourself or any previous connection requests that we received.
  801. * If it's the latter, we try to find a socket in our list of pending
  802. * connections and, if we do, call the appropriate handler for the
  803. * state that that socket is in. Otherwise we try to service the
  804. * connection request.
  805. */
  806. pending = vmci_transport_get_pending(sk, pkt);
  807. if (pending) {
  808. lock_sock(pending);
  809. /* The local context ID may be out of date. */
  810. vsock_sk(pending)->local_addr.svm_cid = pkt->dg.dst.context;
  811. switch (pending->sk_state) {
  812. case TCP_SYN_SENT:
  813. err = vmci_transport_recv_connecting_server(sk,
  814. pending,
  815. pkt);
  816. break;
  817. default:
  818. vmci_transport_send_reset(pending, pkt);
  819. err = -EINVAL;
  820. }
  821. if (err < 0)
  822. vsock_remove_pending(sk, pending);
  823. release_sock(pending);
  824. vmci_transport_release_pending(pending);
  825. return err;
  826. }
  827. /* The listen state only accepts connection requests. Reply with a
  828. * reset unless we received a reset.
  829. */
  830. if (!(pkt->type == VMCI_TRANSPORT_PACKET_TYPE_REQUEST ||
  831. pkt->type == VMCI_TRANSPORT_PACKET_TYPE_REQUEST2)) {
  832. vmci_transport_reply_reset(pkt);
  833. return -EINVAL;
  834. }
  835. if (pkt->u.size == 0) {
  836. vmci_transport_reply_reset(pkt);
  837. return -EINVAL;
  838. }
  839. /* If this socket can't accommodate this connection request, we send a
  840. * reset. Otherwise we create and initialize a child socket and reply
  841. * with a connection negotiation.
  842. */
  843. if (sk->sk_ack_backlog >= sk->sk_max_ack_backlog) {
  844. vmci_transport_reply_reset(pkt);
  845. return -ECONNREFUSED;
  846. }
  847. pending = __vsock_create(sock_net(sk), NULL, sk, GFP_KERNEL,
  848. sk->sk_type, 0);
  849. if (!pending) {
  850. vmci_transport_send_reset(sk, pkt);
  851. return -ENOMEM;
  852. }
  853. vpending = vsock_sk(pending);
  854. vsock_addr_init(&vpending->local_addr, pkt->dg.dst.context,
  855. pkt->dst_port);
  856. vsock_addr_init(&vpending->remote_addr, pkt->dg.src.context,
  857. pkt->src_port);
  858. /* If the proposed size fits within our min/max, accept it. Otherwise
  859. * propose our own size.
  860. */
  861. if (pkt->u.size >= vmci_trans(vpending)->queue_pair_min_size &&
  862. pkt->u.size <= vmci_trans(vpending)->queue_pair_max_size) {
  863. qp_size = pkt->u.size;
  864. } else {
  865. qp_size = vmci_trans(vpending)->queue_pair_size;
  866. }
  867. /* Figure out if we are using old or new requests based on the
  868. * overrides pkt types sent by our peer.
  869. */
  870. if (vmci_transport_old_proto_override(&old_pkt_proto)) {
  871. old_request = old_pkt_proto;
  872. } else {
  873. if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_REQUEST)
  874. old_request = true;
  875. else if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_REQUEST2)
  876. old_request = false;
  877. }
  878. if (old_request) {
  879. /* Handle a REQUEST (or override) */
  880. u16 version = VSOCK_PROTO_INVALID;
  881. if (vmci_transport_proto_to_notify_struct(
  882. pending, &version, true))
  883. err = vmci_transport_send_negotiate(pending, qp_size);
  884. else
  885. err = -EINVAL;
  886. } else {
  887. /* Handle a REQUEST2 (or override) */
  888. int proto_int = pkt->proto;
  889. int pos;
  890. u16 active_proto_version = 0;
  891. /* The list of possible protocols is the intersection of all
  892. * protocols the client supports ... plus all the protocols we
  893. * support.
  894. */
  895. proto_int &= vmci_transport_new_proto_supported_versions();
  896. /* We choose the highest possible protocol version and use that
  897. * one.
  898. */
  899. pos = fls(proto_int);
  900. if (pos) {
  901. active_proto_version = (1 << (pos - 1));
  902. if (vmci_transport_proto_to_notify_struct(
  903. pending, &active_proto_version, false))
  904. err = vmci_transport_send_negotiate2(pending,
  905. qp_size,
  906. active_proto_version);
  907. else
  908. err = -EINVAL;
  909. } else {
  910. err = -EINVAL;
  911. }
  912. }
  913. if (err < 0) {
  914. vmci_transport_send_reset(sk, pkt);
  915. sock_put(pending);
  916. err = vmci_transport_error_to_vsock_error(err);
  917. goto out;
  918. }
  919. vsock_add_pending(sk, pending);
  920. sk->sk_ack_backlog++;
  921. pending->sk_state = TCP_SYN_SENT;
  922. vmci_trans(vpending)->produce_size =
  923. vmci_trans(vpending)->consume_size = qp_size;
  924. vmci_trans(vpending)->queue_pair_size = qp_size;
  925. vmci_trans(vpending)->notify_ops->process_request(pending);
  926. /* We might never receive another message for this socket and it's not
  927. * connected to any process, so we have to ensure it gets cleaned up
  928. * ourself. Our delayed work function will take care of that. Note
  929. * that we do not ever cancel this function since we have few
  930. * guarantees about its state when calling cancel_delayed_work().
  931. * Instead we hold a reference on the socket for that function and make
  932. * it capable of handling cases where it needs to do nothing but
  933. * release that reference.
  934. */
  935. vpending->listener = sk;
  936. sock_hold(sk);
  937. sock_hold(pending);
  938. schedule_delayed_work(&vpending->pending_work, HZ);
  939. out:
  940. return err;
  941. }
  942. static int
  943. vmci_transport_recv_connecting_server(struct sock *listener,
  944. struct sock *pending,
  945. struct vmci_transport_packet *pkt)
  946. {
  947. struct vsock_sock *vpending;
  948. struct vmci_handle handle;
  949. struct vmci_qp *qpair;
  950. bool is_local;
  951. u32 flags;
  952. u32 detach_sub_id;
  953. int err;
  954. int skerr;
  955. vpending = vsock_sk(pending);
  956. detach_sub_id = VMCI_INVALID_ID;
  957. switch (pkt->type) {
  958. case VMCI_TRANSPORT_PACKET_TYPE_OFFER:
  959. if (vmci_handle_is_invalid(pkt->u.handle)) {
  960. vmci_transport_send_reset(pending, pkt);
  961. skerr = EPROTO;
  962. err = -EINVAL;
  963. goto destroy;
  964. }
  965. break;
  966. default:
  967. /* Close and cleanup the connection. */
  968. vmci_transport_send_reset(pending, pkt);
  969. skerr = EPROTO;
  970. err = pkt->type == VMCI_TRANSPORT_PACKET_TYPE_RST ? 0 : -EINVAL;
  971. goto destroy;
  972. }
  973. /* In order to complete the connection we need to attach to the offered
  974. * queue pair and send an attach notification. We also subscribe to the
  975. * detach event so we know when our peer goes away, and we do that
  976. * before attaching so we don't miss an event. If all this succeeds,
  977. * we update our state and wakeup anything waiting in accept() for a
  978. * connection.
  979. */
  980. /* We don't care about attach since we ensure the other side has
  981. * attached by specifying the ATTACH_ONLY flag below.
  982. */
  983. err = vmci_event_subscribe(VMCI_EVENT_QP_PEER_DETACH,
  984. vmci_transport_peer_detach_cb,
  985. vmci_trans(vpending), &detach_sub_id);
  986. if (err < VMCI_SUCCESS) {
  987. vmci_transport_send_reset(pending, pkt);
  988. err = vmci_transport_error_to_vsock_error(err);
  989. skerr = -err;
  990. goto destroy;
  991. }
  992. vmci_trans(vpending)->detach_sub_id = detach_sub_id;
  993. /* Now attach to the queue pair the client created. */
  994. handle = pkt->u.handle;
  995. /* vpending->local_addr always has a context id so we do not need to
  996. * worry about VMADDR_CID_ANY in this case.
  997. */
  998. is_local =
  999. vpending->remote_addr.svm_cid == vpending->local_addr.svm_cid;
  1000. flags = VMCI_QPFLAG_ATTACH_ONLY;
  1001. flags |= is_local ? VMCI_QPFLAG_LOCAL : 0;
  1002. err = vmci_transport_queue_pair_alloc(
  1003. &qpair,
  1004. &handle,
  1005. vmci_trans(vpending)->produce_size,
  1006. vmci_trans(vpending)->consume_size,
  1007. pkt->dg.src.context,
  1008. flags,
  1009. vmci_transport_is_trusted(
  1010. vpending,
  1011. vpending->remote_addr.svm_cid));
  1012. if (err < 0) {
  1013. vmci_transport_send_reset(pending, pkt);
  1014. skerr = -err;
  1015. goto destroy;
  1016. }
  1017. vmci_trans(vpending)->qp_handle = handle;
  1018. vmci_trans(vpending)->qpair = qpair;
  1019. /* When we send the attach message, we must be ready to handle incoming
  1020. * control messages on the newly connected socket. So we move the
  1021. * pending socket to the connected state before sending the attach
  1022. * message. Otherwise, an incoming packet triggered by the attach being
  1023. * received by the peer may be processed concurrently with what happens
  1024. * below after sending the attach message, and that incoming packet
  1025. * will find the listening socket instead of the (currently) pending
  1026. * socket. Note that enqueueing the socket increments the reference
  1027. * count, so even if a reset comes before the connection is accepted,
  1028. * the socket will be valid until it is removed from the queue.
  1029. *
  1030. * If we fail sending the attach below, we remove the socket from the
  1031. * connected list and move the socket to TCP_CLOSE before
  1032. * releasing the lock, so a pending slow path processing of an incoming
  1033. * packet will not see the socket in the connected state in that case.
  1034. */
  1035. pending->sk_state = TCP_ESTABLISHED;
  1036. vsock_insert_connected(vpending);
  1037. /* Notify our peer of our attach. */
  1038. err = vmci_transport_send_attach(pending, handle);
  1039. if (err < 0) {
  1040. vsock_remove_connected(vpending);
  1041. pr_err("Could not send attach\n");
  1042. vmci_transport_send_reset(pending, pkt);
  1043. err = vmci_transport_error_to_vsock_error(err);
  1044. skerr = -err;
  1045. goto destroy;
  1046. }
  1047. /* We have a connection. Move the now connected socket from the
  1048. * listener's pending list to the accept queue so callers of accept()
  1049. * can find it.
  1050. */
  1051. vsock_remove_pending(listener, pending);
  1052. vsock_enqueue_accept(listener, pending);
  1053. /* Callers of accept() will be be waiting on the listening socket, not
  1054. * the pending socket.
  1055. */
  1056. listener->sk_data_ready(listener);
  1057. return 0;
  1058. destroy:
  1059. pending->sk_err = skerr;
  1060. pending->sk_state = TCP_CLOSE;
  1061. /* As long as we drop our reference, all necessary cleanup will handle
  1062. * when the cleanup function drops its reference and our destruct
  1063. * implementation is called. Note that since the listen handler will
  1064. * remove pending from the pending list upon our failure, the cleanup
  1065. * function won't drop the additional reference, which is why we do it
  1066. * here.
  1067. */
  1068. sock_put(pending);
  1069. return err;
  1070. }
  1071. static int
  1072. vmci_transport_recv_connecting_client(struct sock *sk,
  1073. struct vmci_transport_packet *pkt)
  1074. {
  1075. struct vsock_sock *vsk;
  1076. int err;
  1077. int skerr;
  1078. vsk = vsock_sk(sk);
  1079. switch (pkt->type) {
  1080. case VMCI_TRANSPORT_PACKET_TYPE_ATTACH:
  1081. if (vmci_handle_is_invalid(pkt->u.handle) ||
  1082. !vmci_handle_is_equal(pkt->u.handle,
  1083. vmci_trans(vsk)->qp_handle)) {
  1084. skerr = EPROTO;
  1085. err = -EINVAL;
  1086. goto destroy;
  1087. }
  1088. /* Signify the socket is connected and wakeup the waiter in
  1089. * connect(). Also place the socket in the connected table for
  1090. * accounting (it can already be found since it's in the bound
  1091. * table).
  1092. */
  1093. sk->sk_state = TCP_ESTABLISHED;
  1094. sk->sk_socket->state = SS_CONNECTED;
  1095. vsock_insert_connected(vsk);
  1096. sk->sk_state_change(sk);
  1097. break;
  1098. case VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE:
  1099. case VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE2:
  1100. if (pkt->u.size == 0
  1101. || pkt->dg.src.context != vsk->remote_addr.svm_cid
  1102. || pkt->src_port != vsk->remote_addr.svm_port
  1103. || !vmci_handle_is_invalid(vmci_trans(vsk)->qp_handle)
  1104. || vmci_trans(vsk)->qpair
  1105. || vmci_trans(vsk)->produce_size != 0
  1106. || vmci_trans(vsk)->consume_size != 0
  1107. || vmci_trans(vsk)->detach_sub_id != VMCI_INVALID_ID) {
  1108. skerr = EPROTO;
  1109. err = -EINVAL;
  1110. goto destroy;
  1111. }
  1112. err = vmci_transport_recv_connecting_client_negotiate(sk, pkt);
  1113. if (err) {
  1114. skerr = -err;
  1115. goto destroy;
  1116. }
  1117. break;
  1118. case VMCI_TRANSPORT_PACKET_TYPE_INVALID:
  1119. err = vmci_transport_recv_connecting_client_invalid(sk, pkt);
  1120. if (err) {
  1121. skerr = -err;
  1122. goto destroy;
  1123. }
  1124. break;
  1125. case VMCI_TRANSPORT_PACKET_TYPE_RST:
  1126. /* Older versions of the linux code (WS 6.5 / ESX 4.0) used to
  1127. * continue processing here after they sent an INVALID packet.
  1128. * This meant that we got a RST after the INVALID. We ignore a
  1129. * RST after an INVALID. The common code doesn't send the RST
  1130. * ... so we can hang if an old version of the common code
  1131. * fails between getting a REQUEST and sending an OFFER back.
  1132. * Not much we can do about it... except hope that it doesn't
  1133. * happen.
  1134. */
  1135. if (vsk->ignore_connecting_rst) {
  1136. vsk->ignore_connecting_rst = false;
  1137. } else {
  1138. skerr = ECONNRESET;
  1139. err = 0;
  1140. goto destroy;
  1141. }
  1142. break;
  1143. default:
  1144. /* Close and cleanup the connection. */
  1145. skerr = EPROTO;
  1146. err = -EINVAL;
  1147. goto destroy;
  1148. }
  1149. return 0;
  1150. destroy:
  1151. vmci_transport_send_reset(sk, pkt);
  1152. sk->sk_state = TCP_CLOSE;
  1153. sk->sk_err = skerr;
  1154. sk->sk_error_report(sk);
  1155. return err;
  1156. }
  1157. static int vmci_transport_recv_connecting_client_negotiate(
  1158. struct sock *sk,
  1159. struct vmci_transport_packet *pkt)
  1160. {
  1161. int err;
  1162. struct vsock_sock *vsk;
  1163. struct vmci_handle handle;
  1164. struct vmci_qp *qpair;
  1165. u32 detach_sub_id;
  1166. bool is_local;
  1167. u32 flags;
  1168. bool old_proto = true;
  1169. bool old_pkt_proto;
  1170. u16 version;
  1171. vsk = vsock_sk(sk);
  1172. handle = VMCI_INVALID_HANDLE;
  1173. detach_sub_id = VMCI_INVALID_ID;
  1174. /* If we have gotten here then we should be past the point where old
  1175. * linux vsock could have sent the bogus rst.
  1176. */
  1177. vsk->sent_request = false;
  1178. vsk->ignore_connecting_rst = false;
  1179. /* Verify that we're OK with the proposed queue pair size */
  1180. if (pkt->u.size < vmci_trans(vsk)->queue_pair_min_size ||
  1181. pkt->u.size > vmci_trans(vsk)->queue_pair_max_size) {
  1182. err = -EINVAL;
  1183. goto destroy;
  1184. }
  1185. /* At this point we know the CID the peer is using to talk to us. */
  1186. if (vsk->local_addr.svm_cid == VMADDR_CID_ANY)
  1187. vsk->local_addr.svm_cid = pkt->dg.dst.context;
  1188. /* Setup the notify ops to be the highest supported version that both
  1189. * the server and the client support.
  1190. */
  1191. if (vmci_transport_old_proto_override(&old_pkt_proto)) {
  1192. old_proto = old_pkt_proto;
  1193. } else {
  1194. if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE)
  1195. old_proto = true;
  1196. else if (pkt->type == VMCI_TRANSPORT_PACKET_TYPE_NEGOTIATE2)
  1197. old_proto = false;
  1198. }
  1199. if (old_proto)
  1200. version = VSOCK_PROTO_INVALID;
  1201. else
  1202. version = pkt->proto;
  1203. if (!vmci_transport_proto_to_notify_struct(sk, &version, old_proto)) {
  1204. err = -EINVAL;
  1205. goto destroy;
  1206. }
  1207. /* Subscribe to detach events first.
  1208. *
  1209. * XXX We attach once for each queue pair created for now so it is easy
  1210. * to find the socket (it's provided), but later we should only
  1211. * subscribe once and add a way to lookup sockets by queue pair handle.
  1212. */
  1213. err = vmci_event_subscribe(VMCI_EVENT_QP_PEER_DETACH,
  1214. vmci_transport_peer_detach_cb,
  1215. vmci_trans(vsk), &detach_sub_id);
  1216. if (err < VMCI_SUCCESS) {
  1217. err = vmci_transport_error_to_vsock_error(err);
  1218. goto destroy;
  1219. }
  1220. /* Make VMCI select the handle for us. */
  1221. handle = VMCI_INVALID_HANDLE;
  1222. is_local = vsk->remote_addr.svm_cid == vsk->local_addr.svm_cid;
  1223. flags = is_local ? VMCI_QPFLAG_LOCAL : 0;
  1224. err = vmci_transport_queue_pair_alloc(&qpair,
  1225. &handle,
  1226. pkt->u.size,
  1227. pkt->u.size,
  1228. vsk->remote_addr.svm_cid,
  1229. flags,
  1230. vmci_transport_is_trusted(
  1231. vsk,
  1232. vsk->
  1233. remote_addr.svm_cid));
  1234. if (err < 0)
  1235. goto destroy;
  1236. err = vmci_transport_send_qp_offer(sk, handle);
  1237. if (err < 0) {
  1238. err = vmci_transport_error_to_vsock_error(err);
  1239. goto destroy;
  1240. }
  1241. vmci_trans(vsk)->qp_handle = handle;
  1242. vmci_trans(vsk)->qpair = qpair;
  1243. vmci_trans(vsk)->produce_size = vmci_trans(vsk)->consume_size =
  1244. pkt->u.size;
  1245. vmci_trans(vsk)->detach_sub_id = detach_sub_id;
  1246. vmci_trans(vsk)->notify_ops->process_negotiate(sk);
  1247. return 0;
  1248. destroy:
  1249. if (detach_sub_id != VMCI_INVALID_ID)
  1250. vmci_event_unsubscribe(detach_sub_id);
  1251. if (!vmci_handle_is_invalid(handle))
  1252. vmci_qpair_detach(&qpair);
  1253. return err;
  1254. }
  1255. static int
  1256. vmci_transport_recv_connecting_client_invalid(struct sock *sk,
  1257. struct vmci_transport_packet *pkt)
  1258. {
  1259. int err = 0;
  1260. struct vsock_sock *vsk = vsock_sk(sk);
  1261. if (vsk->sent_request) {
  1262. vsk->sent_request = false;
  1263. vsk->ignore_connecting_rst = true;
  1264. err = vmci_transport_send_conn_request(
  1265. sk, vmci_trans(vsk)->queue_pair_size);
  1266. if (err < 0)
  1267. err = vmci_transport_error_to_vsock_error(err);
  1268. else
  1269. err = 0;
  1270. }
  1271. return err;
  1272. }
  1273. static int vmci_transport_recv_connected(struct sock *sk,
  1274. struct vmci_transport_packet *pkt)
  1275. {
  1276. struct vsock_sock *vsk;
  1277. bool pkt_processed = false;
  1278. /* In cases where we are closing the connection, it's sufficient to
  1279. * mark the state change (and maybe error) and wake up any waiting
  1280. * threads. Since this is a connected socket, it's owned by a user
  1281. * process and will be cleaned up when the failure is passed back on
  1282. * the current or next system call. Our system call implementations
  1283. * must therefore check for error and state changes on entry and when
  1284. * being awoken.
  1285. */
  1286. switch (pkt->type) {
  1287. case VMCI_TRANSPORT_PACKET_TYPE_SHUTDOWN:
  1288. if (pkt->u.mode) {
  1289. vsk = vsock_sk(sk);
  1290. vsk->peer_shutdown |= pkt->u.mode;
  1291. sk->sk_state_change(sk);
  1292. }
  1293. break;
  1294. case VMCI_TRANSPORT_PACKET_TYPE_RST:
  1295. vsk = vsock_sk(sk);
  1296. /* It is possible that we sent our peer a message (e.g a
  1297. * WAITING_READ) right before we got notified that the peer had
  1298. * detached. If that happens then we can get a RST pkt back
  1299. * from our peer even though there is data available for us to
  1300. * read. In that case, don't shutdown the socket completely but
  1301. * instead allow the local client to finish reading data off
  1302. * the queuepair. Always treat a RST pkt in connected mode like
  1303. * a clean shutdown.
  1304. */
  1305. sock_set_flag(sk, SOCK_DONE);
  1306. vsk->peer_shutdown = SHUTDOWN_MASK;
  1307. if (vsock_stream_has_data(vsk) <= 0)
  1308. sk->sk_state = TCP_CLOSING;
  1309. sk->sk_state_change(sk);
  1310. break;
  1311. default:
  1312. vsk = vsock_sk(sk);
  1313. vmci_trans(vsk)->notify_ops->handle_notify_pkt(
  1314. sk, pkt, false, NULL, NULL,
  1315. &pkt_processed);
  1316. if (!pkt_processed)
  1317. return -EINVAL;
  1318. break;
  1319. }
  1320. return 0;
  1321. }
  1322. static int vmci_transport_socket_init(struct vsock_sock *vsk,
  1323. struct vsock_sock *psk)
  1324. {
  1325. vsk->trans = kmalloc(sizeof(struct vmci_transport), GFP_KERNEL);
  1326. if (!vsk->trans)
  1327. return -ENOMEM;
  1328. vmci_trans(vsk)->dg_handle = VMCI_INVALID_HANDLE;
  1329. vmci_trans(vsk)->qp_handle = VMCI_INVALID_HANDLE;
  1330. vmci_trans(vsk)->qpair = NULL;
  1331. vmci_trans(vsk)->produce_size = vmci_trans(vsk)->consume_size = 0;
  1332. vmci_trans(vsk)->detach_sub_id = VMCI_INVALID_ID;
  1333. vmci_trans(vsk)->notify_ops = NULL;
  1334. INIT_LIST_HEAD(&vmci_trans(vsk)->elem);
  1335. vmci_trans(vsk)->sk = &vsk->sk;
  1336. spin_lock_init(&vmci_trans(vsk)->lock);
  1337. if (psk) {
  1338. vmci_trans(vsk)->queue_pair_size =
  1339. vmci_trans(psk)->queue_pair_size;
  1340. vmci_trans(vsk)->queue_pair_min_size =
  1341. vmci_trans(psk)->queue_pair_min_size;
  1342. vmci_trans(vsk)->queue_pair_max_size =
  1343. vmci_trans(psk)->queue_pair_max_size;
  1344. } else {
  1345. vmci_trans(vsk)->queue_pair_size =
  1346. VMCI_TRANSPORT_DEFAULT_QP_SIZE;
  1347. vmci_trans(vsk)->queue_pair_min_size =
  1348. VMCI_TRANSPORT_DEFAULT_QP_SIZE_MIN;
  1349. vmci_trans(vsk)->queue_pair_max_size =
  1350. VMCI_TRANSPORT_DEFAULT_QP_SIZE_MAX;
  1351. }
  1352. return 0;
  1353. }
  1354. static void vmci_transport_free_resources(struct list_head *transport_list)
  1355. {
  1356. while (!list_empty(transport_list)) {
  1357. struct vmci_transport *transport =
  1358. list_first_entry(transport_list, struct vmci_transport,
  1359. elem);
  1360. list_del(&transport->elem);
  1361. if (transport->detach_sub_id != VMCI_INVALID_ID) {
  1362. vmci_event_unsubscribe(transport->detach_sub_id);
  1363. transport->detach_sub_id = VMCI_INVALID_ID;
  1364. }
  1365. if (!vmci_handle_is_invalid(transport->qp_handle)) {
  1366. vmci_qpair_detach(&transport->qpair);
  1367. transport->qp_handle = VMCI_INVALID_HANDLE;
  1368. transport->produce_size = 0;
  1369. transport->consume_size = 0;
  1370. }
  1371. kfree(transport);
  1372. }
  1373. }
  1374. static void vmci_transport_cleanup(struct work_struct *work)
  1375. {
  1376. LIST_HEAD(pending);
  1377. spin_lock_bh(&vmci_transport_cleanup_lock);
  1378. list_replace_init(&vmci_transport_cleanup_list, &pending);
  1379. spin_unlock_bh(&vmci_transport_cleanup_lock);
  1380. vmci_transport_free_resources(&pending);
  1381. }
  1382. static void vmci_transport_destruct(struct vsock_sock *vsk)
  1383. {
  1384. /* Ensure that the detach callback doesn't use the sk/vsk
  1385. * we are about to destruct.
  1386. */
  1387. spin_lock_bh(&vmci_trans(vsk)->lock);
  1388. vmci_trans(vsk)->sk = NULL;
  1389. spin_unlock_bh(&vmci_trans(vsk)->lock);
  1390. if (vmci_trans(vsk)->notify_ops)
  1391. vmci_trans(vsk)->notify_ops->socket_destruct(vsk);
  1392. spin_lock_bh(&vmci_transport_cleanup_lock);
  1393. list_add(&vmci_trans(vsk)->elem, &vmci_transport_cleanup_list);
  1394. spin_unlock_bh(&vmci_transport_cleanup_lock);
  1395. schedule_work(&vmci_transport_cleanup_work);
  1396. vsk->trans = NULL;
  1397. }
  1398. static void vmci_transport_release(struct vsock_sock *vsk)
  1399. {
  1400. vsock_remove_sock(vsk);
  1401. if (!vmci_handle_is_invalid(vmci_trans(vsk)->dg_handle)) {
  1402. vmci_datagram_destroy_handle(vmci_trans(vsk)->dg_handle);
  1403. vmci_trans(vsk)->dg_handle = VMCI_INVALID_HANDLE;
  1404. }
  1405. }
  1406. static int vmci_transport_dgram_bind(struct vsock_sock *vsk,
  1407. struct sockaddr_vm *addr)
  1408. {
  1409. u32 port;
  1410. u32 flags;
  1411. int err;
  1412. /* VMCI will select a resource ID for us if we provide
  1413. * VMCI_INVALID_ID.
  1414. */
  1415. port = addr->svm_port == VMADDR_PORT_ANY ?
  1416. VMCI_INVALID_ID : addr->svm_port;
  1417. if (port <= LAST_RESERVED_PORT && !capable(CAP_NET_BIND_SERVICE))
  1418. return -EACCES;
  1419. flags = addr->svm_cid == VMADDR_CID_ANY ?
  1420. VMCI_FLAG_ANYCID_DG_HND : 0;
  1421. err = vmci_transport_datagram_create_hnd(port, flags,
  1422. vmci_transport_recv_dgram_cb,
  1423. &vsk->sk,
  1424. &vmci_trans(vsk)->dg_handle);
  1425. if (err < VMCI_SUCCESS)
  1426. return vmci_transport_error_to_vsock_error(err);
  1427. vsock_addr_init(&vsk->local_addr, addr->svm_cid,
  1428. vmci_trans(vsk)->dg_handle.resource);
  1429. return 0;
  1430. }
  1431. static int vmci_transport_dgram_enqueue(
  1432. struct vsock_sock *vsk,
  1433. struct sockaddr_vm *remote_addr,
  1434. struct msghdr *msg,
  1435. size_t len)
  1436. {
  1437. int err;
  1438. struct vmci_datagram *dg;
  1439. if (len > VMCI_MAX_DG_PAYLOAD_SIZE)
  1440. return -EMSGSIZE;
  1441. if (!vmci_transport_allow_dgram(vsk, remote_addr->svm_cid))
  1442. return -EPERM;
  1443. /* Allocate a buffer for the user's message and our packet header. */
  1444. dg = kmalloc(len + sizeof(*dg), GFP_KERNEL);
  1445. if (!dg)
  1446. return -ENOMEM;
  1447. memcpy_from_msg(VMCI_DG_PAYLOAD(dg), msg, len);
  1448. dg->dst = vmci_make_handle(remote_addr->svm_cid,
  1449. remote_addr->svm_port);
  1450. dg->src = vmci_make_handle(vsk->local_addr.svm_cid,
  1451. vsk->local_addr.svm_port);
  1452. dg->payload_size = len;
  1453. err = vmci_datagram_send(dg);
  1454. kfree(dg);
  1455. if (err < 0)
  1456. return vmci_transport_error_to_vsock_error(err);
  1457. return err - sizeof(*dg);
  1458. }
  1459. static int vmci_transport_dgram_dequeue(struct vsock_sock *vsk,
  1460. struct msghdr *msg, size_t len,
  1461. int flags)
  1462. {
  1463. int err;
  1464. int noblock;
  1465. struct vmci_datagram *dg;
  1466. size_t payload_len;
  1467. struct sk_buff *skb;
  1468. noblock = flags & MSG_DONTWAIT;
  1469. if (flags & MSG_OOB || flags & MSG_ERRQUEUE)
  1470. return -EOPNOTSUPP;
  1471. /* Retrieve the head sk_buff from the socket's receive queue. */
  1472. err = 0;
  1473. skb = skb_recv_datagram(&vsk->sk, flags, noblock, &err);
  1474. if (!skb)
  1475. return err;
  1476. dg = (struct vmci_datagram *)skb->data;
  1477. if (!dg)
  1478. /* err is 0, meaning we read zero bytes. */
  1479. goto out;
  1480. payload_len = dg->payload_size;
  1481. /* Ensure the sk_buff matches the payload size claimed in the packet. */
  1482. if (payload_len != skb->len - sizeof(*dg)) {
  1483. err = -EINVAL;
  1484. goto out;
  1485. }
  1486. if (payload_len > len) {
  1487. payload_len = len;
  1488. msg->msg_flags |= MSG_TRUNC;
  1489. }
  1490. /* Place the datagram payload in the user's iovec. */
  1491. err = skb_copy_datagram_msg(skb, sizeof(*dg), msg, payload_len);
  1492. if (err)
  1493. goto out;
  1494. if (msg->msg_name) {
  1495. /* Provide the address of the sender. */
  1496. DECLARE_SOCKADDR(struct sockaddr_vm *, vm_addr, msg->msg_name);
  1497. vsock_addr_init(vm_addr, dg->src.context, dg->src.resource);
  1498. msg->msg_namelen = sizeof(*vm_addr);
  1499. }
  1500. err = payload_len;
  1501. out:
  1502. skb_free_datagram(&vsk->sk, skb);
  1503. return err;
  1504. }
  1505. static bool vmci_transport_dgram_allow(u32 cid, u32 port)
  1506. {
  1507. if (cid == VMADDR_CID_HYPERVISOR) {
  1508. /* Registrations of PBRPC Servers do not modify VMX/Hypervisor
  1509. * state and are allowed.
  1510. */
  1511. return port == VMCI_UNITY_PBRPC_REGISTER;
  1512. }
  1513. return true;
  1514. }
  1515. static int vmci_transport_connect(struct vsock_sock *vsk)
  1516. {
  1517. int err;
  1518. bool old_pkt_proto = false;
  1519. struct sock *sk = &vsk->sk;
  1520. if (vmci_transport_old_proto_override(&old_pkt_proto) &&
  1521. old_pkt_proto) {
  1522. err = vmci_transport_send_conn_request(
  1523. sk, vmci_trans(vsk)->queue_pair_size);
  1524. if (err < 0) {
  1525. sk->sk_state = TCP_CLOSE;
  1526. return err;
  1527. }
  1528. } else {
  1529. int supported_proto_versions =
  1530. vmci_transport_new_proto_supported_versions();
  1531. err = vmci_transport_send_conn_request2(
  1532. sk, vmci_trans(vsk)->queue_pair_size,
  1533. supported_proto_versions);
  1534. if (err < 0) {
  1535. sk->sk_state = TCP_CLOSE;
  1536. return err;
  1537. }
  1538. vsk->sent_request = true;
  1539. }
  1540. return err;
  1541. }
  1542. static ssize_t vmci_transport_stream_dequeue(
  1543. struct vsock_sock *vsk,
  1544. struct msghdr *msg,
  1545. size_t len,
  1546. int flags)
  1547. {
  1548. if (flags & MSG_PEEK)
  1549. return vmci_qpair_peekv(vmci_trans(vsk)->qpair, msg, len, 0);
  1550. else
  1551. return vmci_qpair_dequev(vmci_trans(vsk)->qpair, msg, len, 0);
  1552. }
  1553. static ssize_t vmci_transport_stream_enqueue(
  1554. struct vsock_sock *vsk,
  1555. struct msghdr *msg,
  1556. size_t len)
  1557. {
  1558. return vmci_qpair_enquev(vmci_trans(vsk)->qpair, msg, len, 0);
  1559. }
  1560. static s64 vmci_transport_stream_has_data(struct vsock_sock *vsk)
  1561. {
  1562. return vmci_qpair_consume_buf_ready(vmci_trans(vsk)->qpair);
  1563. }
  1564. static s64 vmci_transport_stream_has_space(struct vsock_sock *vsk)
  1565. {
  1566. return vmci_qpair_produce_free_space(vmci_trans(vsk)->qpair);
  1567. }
  1568. static u64 vmci_transport_stream_rcvhiwat(struct vsock_sock *vsk)
  1569. {
  1570. return vmci_trans(vsk)->consume_size;
  1571. }
  1572. static bool vmci_transport_stream_is_active(struct vsock_sock *vsk)
  1573. {
  1574. return !vmci_handle_is_invalid(vmci_trans(vsk)->qp_handle);
  1575. }
  1576. static u64 vmci_transport_get_buffer_size(struct vsock_sock *vsk)
  1577. {
  1578. return vmci_trans(vsk)->queue_pair_size;
  1579. }
  1580. static u64 vmci_transport_get_min_buffer_size(struct vsock_sock *vsk)
  1581. {
  1582. return vmci_trans(vsk)->queue_pair_min_size;
  1583. }
  1584. static u64 vmci_transport_get_max_buffer_size(struct vsock_sock *vsk)
  1585. {
  1586. return vmci_trans(vsk)->queue_pair_max_size;
  1587. }
  1588. static void vmci_transport_set_buffer_size(struct vsock_sock *vsk, u64 val)
  1589. {
  1590. if (val < vmci_trans(vsk)->queue_pair_min_size)
  1591. vmci_trans(vsk)->queue_pair_min_size = val;
  1592. if (val > vmci_trans(vsk)->queue_pair_max_size)
  1593. vmci_trans(vsk)->queue_pair_max_size = val;
  1594. vmci_trans(vsk)->queue_pair_size = val;
  1595. }
  1596. static void vmci_transport_set_min_buffer_size(struct vsock_sock *vsk,
  1597. u64 val)
  1598. {
  1599. if (val > vmci_trans(vsk)->queue_pair_size)
  1600. vmci_trans(vsk)->queue_pair_size = val;
  1601. vmci_trans(vsk)->queue_pair_min_size = val;
  1602. }
  1603. static void vmci_transport_set_max_buffer_size(struct vsock_sock *vsk,
  1604. u64 val)
  1605. {
  1606. if (val < vmci_trans(vsk)->queue_pair_size)
  1607. vmci_trans(vsk)->queue_pair_size = val;
  1608. vmci_trans(vsk)->queue_pair_max_size = val;
  1609. }
  1610. static int vmci_transport_notify_poll_in(
  1611. struct vsock_sock *vsk,
  1612. size_t target,
  1613. bool *data_ready_now)
  1614. {
  1615. return vmci_trans(vsk)->notify_ops->poll_in(
  1616. &vsk->sk, target, data_ready_now);
  1617. }
  1618. static int vmci_transport_notify_poll_out(
  1619. struct vsock_sock *vsk,
  1620. size_t target,
  1621. bool *space_available_now)
  1622. {
  1623. return vmci_trans(vsk)->notify_ops->poll_out(
  1624. &vsk->sk, target, space_available_now);
  1625. }
  1626. static int vmci_transport_notify_recv_init(
  1627. struct vsock_sock *vsk,
  1628. size_t target,
  1629. struct vsock_transport_recv_notify_data *data)
  1630. {
  1631. return vmci_trans(vsk)->notify_ops->recv_init(
  1632. &vsk->sk, target,
  1633. (struct vmci_transport_recv_notify_data *)data);
  1634. }
  1635. static int vmci_transport_notify_recv_pre_block(
  1636. struct vsock_sock *vsk,
  1637. size_t target,
  1638. struct vsock_transport_recv_notify_data *data)
  1639. {
  1640. return vmci_trans(vsk)->notify_ops->recv_pre_block(
  1641. &vsk->sk, target,
  1642. (struct vmci_transport_recv_notify_data *)data);
  1643. }
  1644. static int vmci_transport_notify_recv_pre_dequeue(
  1645. struct vsock_sock *vsk,
  1646. size_t target,
  1647. struct vsock_transport_recv_notify_data *data)
  1648. {
  1649. return vmci_trans(vsk)->notify_ops->recv_pre_dequeue(
  1650. &vsk->sk, target,
  1651. (struct vmci_transport_recv_notify_data *)data);
  1652. }
  1653. static int vmci_transport_notify_recv_post_dequeue(
  1654. struct vsock_sock *vsk,
  1655. size_t target,
  1656. ssize_t copied,
  1657. bool data_read,
  1658. struct vsock_transport_recv_notify_data *data)
  1659. {
  1660. return vmci_trans(vsk)->notify_ops->recv_post_dequeue(
  1661. &vsk->sk, target, copied, data_read,
  1662. (struct vmci_transport_recv_notify_data *)data);
  1663. }
  1664. static int vmci_transport_notify_send_init(
  1665. struct vsock_sock *vsk,
  1666. struct vsock_transport_send_notify_data *data)
  1667. {
  1668. return vmci_trans(vsk)->notify_ops->send_init(
  1669. &vsk->sk,
  1670. (struct vmci_transport_send_notify_data *)data);
  1671. }
  1672. static int vmci_transport_notify_send_pre_block(
  1673. struct vsock_sock *vsk,
  1674. struct vsock_transport_send_notify_data *data)
  1675. {
  1676. return vmci_trans(vsk)->notify_ops->send_pre_block(
  1677. &vsk->sk,
  1678. (struct vmci_transport_send_notify_data *)data);
  1679. }
  1680. static int vmci_transport_notify_send_pre_enqueue(
  1681. struct vsock_sock *vsk,
  1682. struct vsock_transport_send_notify_data *data)
  1683. {
  1684. return vmci_trans(vsk)->notify_ops->send_pre_enqueue(
  1685. &vsk->sk,
  1686. (struct vmci_transport_send_notify_data *)data);
  1687. }
  1688. static int vmci_transport_notify_send_post_enqueue(
  1689. struct vsock_sock *vsk,
  1690. ssize_t written,
  1691. struct vsock_transport_send_notify_data *data)
  1692. {
  1693. return vmci_trans(vsk)->notify_ops->send_post_enqueue(
  1694. &vsk->sk, written,
  1695. (struct vmci_transport_send_notify_data *)data);
  1696. }
  1697. static bool vmci_transport_old_proto_override(bool *old_pkt_proto)
  1698. {
  1699. if (PROTOCOL_OVERRIDE != -1) {
  1700. if (PROTOCOL_OVERRIDE == 0)
  1701. *old_pkt_proto = true;
  1702. else
  1703. *old_pkt_proto = false;
  1704. pr_info("Proto override in use\n");
  1705. return true;
  1706. }
  1707. return false;
  1708. }
  1709. static bool vmci_transport_proto_to_notify_struct(struct sock *sk,
  1710. u16 *proto,
  1711. bool old_pkt_proto)
  1712. {
  1713. struct vsock_sock *vsk = vsock_sk(sk);
  1714. if (old_pkt_proto) {
  1715. if (*proto != VSOCK_PROTO_INVALID) {
  1716. pr_err("Can't set both an old and new protocol\n");
  1717. return false;
  1718. }
  1719. vmci_trans(vsk)->notify_ops = &vmci_transport_notify_pkt_ops;
  1720. goto exit;
  1721. }
  1722. switch (*proto) {
  1723. case VSOCK_PROTO_PKT_ON_NOTIFY:
  1724. vmci_trans(vsk)->notify_ops =
  1725. &vmci_transport_notify_pkt_q_state_ops;
  1726. break;
  1727. default:
  1728. pr_err("Unknown notify protocol version\n");
  1729. return false;
  1730. }
  1731. exit:
  1732. vmci_trans(vsk)->notify_ops->socket_init(sk);
  1733. return true;
  1734. }
  1735. static u16 vmci_transport_new_proto_supported_versions(void)
  1736. {
  1737. if (PROTOCOL_OVERRIDE != -1)
  1738. return PROTOCOL_OVERRIDE;
  1739. return VSOCK_PROTO_ALL_SUPPORTED;
  1740. }
  1741. static u32 vmci_transport_get_local_cid(void)
  1742. {
  1743. return vmci_get_context_id();
  1744. }
  1745. static const struct vsock_transport vmci_transport = {
  1746. .init = vmci_transport_socket_init,
  1747. .destruct = vmci_transport_destruct,
  1748. .release = vmci_transport_release,
  1749. .connect = vmci_transport_connect,
  1750. .dgram_bind = vmci_transport_dgram_bind,
  1751. .dgram_dequeue = vmci_transport_dgram_dequeue,
  1752. .dgram_enqueue = vmci_transport_dgram_enqueue,
  1753. .dgram_allow = vmci_transport_dgram_allow,
  1754. .stream_dequeue = vmci_transport_stream_dequeue,
  1755. .stream_enqueue = vmci_transport_stream_enqueue,
  1756. .stream_has_data = vmci_transport_stream_has_data,
  1757. .stream_has_space = vmci_transport_stream_has_space,
  1758. .stream_rcvhiwat = vmci_transport_stream_rcvhiwat,
  1759. .stream_is_active = vmci_transport_stream_is_active,
  1760. .stream_allow = vmci_transport_stream_allow,
  1761. .notify_poll_in = vmci_transport_notify_poll_in,
  1762. .notify_poll_out = vmci_transport_notify_poll_out,
  1763. .notify_recv_init = vmci_transport_notify_recv_init,
  1764. .notify_recv_pre_block = vmci_transport_notify_recv_pre_block,
  1765. .notify_recv_pre_dequeue = vmci_transport_notify_recv_pre_dequeue,
  1766. .notify_recv_post_dequeue = vmci_transport_notify_recv_post_dequeue,
  1767. .notify_send_init = vmci_transport_notify_send_init,
  1768. .notify_send_pre_block = vmci_transport_notify_send_pre_block,
  1769. .notify_send_pre_enqueue = vmci_transport_notify_send_pre_enqueue,
  1770. .notify_send_post_enqueue = vmci_transport_notify_send_post_enqueue,
  1771. .shutdown = vmci_transport_shutdown,
  1772. .set_buffer_size = vmci_transport_set_buffer_size,
  1773. .set_min_buffer_size = vmci_transport_set_min_buffer_size,
  1774. .set_max_buffer_size = vmci_transport_set_max_buffer_size,
  1775. .get_buffer_size = vmci_transport_get_buffer_size,
  1776. .get_min_buffer_size = vmci_transport_get_min_buffer_size,
  1777. .get_max_buffer_size = vmci_transport_get_max_buffer_size,
  1778. .get_local_cid = vmci_transport_get_local_cid,
  1779. };
  1780. static int __init vmci_transport_init(void)
  1781. {
  1782. int err;
  1783. /* Create the datagram handle that we will use to send and receive all
  1784. * VSocket control messages for this context.
  1785. */
  1786. err = vmci_transport_datagram_create_hnd(VMCI_TRANSPORT_PACKET_RID,
  1787. VMCI_FLAG_ANYCID_DG_HND,
  1788. vmci_transport_recv_stream_cb,
  1789. NULL,
  1790. &vmci_transport_stream_handle);
  1791. if (err < VMCI_SUCCESS) {
  1792. pr_err("Unable to create datagram handle. (%d)\n", err);
  1793. return vmci_transport_error_to_vsock_error(err);
  1794. }
  1795. err = vmci_event_subscribe(VMCI_EVENT_QP_RESUMED,
  1796. vmci_transport_qp_resumed_cb,
  1797. NULL, &vmci_transport_qp_resumed_sub_id);
  1798. if (err < VMCI_SUCCESS) {
  1799. pr_err("Unable to subscribe to resumed event. (%d)\n", err);
  1800. err = vmci_transport_error_to_vsock_error(err);
  1801. vmci_transport_qp_resumed_sub_id = VMCI_INVALID_ID;
  1802. goto err_destroy_stream_handle;
  1803. }
  1804. err = vsock_core_init(&vmci_transport);
  1805. if (err < 0)
  1806. goto err_unsubscribe;
  1807. return 0;
  1808. err_unsubscribe:
  1809. vmci_event_unsubscribe(vmci_transport_qp_resumed_sub_id);
  1810. err_destroy_stream_handle:
  1811. vmci_datagram_destroy_handle(vmci_transport_stream_handle);
  1812. return err;
  1813. }
  1814. module_init(vmci_transport_init);
  1815. static void __exit vmci_transport_exit(void)
  1816. {
  1817. cancel_work_sync(&vmci_transport_cleanup_work);
  1818. vmci_transport_free_resources(&vmci_transport_cleanup_list);
  1819. if (!vmci_handle_is_invalid(vmci_transport_stream_handle)) {
  1820. if (vmci_datagram_destroy_handle(
  1821. vmci_transport_stream_handle) != VMCI_SUCCESS)
  1822. pr_err("Couldn't destroy datagram handle\n");
  1823. vmci_transport_stream_handle = VMCI_INVALID_HANDLE;
  1824. }
  1825. if (vmci_transport_qp_resumed_sub_id != VMCI_INVALID_ID) {
  1826. vmci_event_unsubscribe(vmci_transport_qp_resumed_sub_id);
  1827. vmci_transport_qp_resumed_sub_id = VMCI_INVALID_ID;
  1828. }
  1829. vsock_core_exit();
  1830. }
  1831. module_exit(vmci_transport_exit);
  1832. MODULE_AUTHOR("VMware, Inc.");
  1833. MODULE_DESCRIPTION("VMCI transport for Virtual Sockets");
  1834. MODULE_VERSION("1.0.5.0-k");
  1835. MODULE_LICENSE("GPL v2");
  1836. MODULE_ALIAS("vmware_vsock");
  1837. MODULE_ALIAS_NETPROTO(PF_VSOCK);