1
2
3
4
5
6
7
8
9
10
11
12#include <linux/slab.h>
13#include "ar-internal.h"
14
15
16
17
18
19
20
21
22
23
24
25struct rxrpc_connection *rxrpc_find_service_conn_rcu(struct rxrpc_peer *peer,
26 struct sk_buff *skb)
27{
28 struct rxrpc_connection *conn = NULL;
29 struct rxrpc_conn_proto k;
30 struct rxrpc_skb_priv *sp = rxrpc_skb(skb);
31 struct rb_node *p;
32 unsigned int seq = 0;
33
34 k.epoch = sp->hdr.epoch;
35 k.cid = sp->hdr.cid & RXRPC_CIDMASK;
36
37 do {
38
39
40
41
42 read_seqbegin_or_lock(&peer->service_conn_lock, &seq);
43
44 p = rcu_dereference_raw(peer->service_conns.rb_node);
45 while (p) {
46 conn = rb_entry(p, struct rxrpc_connection, service_node);
47
48 if (conn->proto.index_key < k.index_key)
49 p = rcu_dereference_raw(p->rb_left);
50 else if (conn->proto.index_key > k.index_key)
51 p = rcu_dereference_raw(p->rb_right);
52 else
53 break;
54 conn = NULL;
55 }
56 } while (need_seqretry(&peer->service_conn_lock, seq));
57
58 done_seqretry(&peer->service_conn_lock, seq);
59 _leave(" = %d", conn ? conn->debug_id : -1);
60 return conn;
61}
62
63
64
65
66
67static void rxrpc_publish_service_conn(struct rxrpc_peer *peer,
68 struct rxrpc_connection *conn)
69{
70 struct rxrpc_connection *cursor = NULL;
71 struct rxrpc_conn_proto k = conn->proto;
72 struct rb_node **pp, *parent;
73
74 write_seqlock_bh(&peer->service_conn_lock);
75
76 pp = &peer->service_conns.rb_node;
77 parent = NULL;
78 while (*pp) {
79 parent = *pp;
80 cursor = rb_entry(parent,
81 struct rxrpc_connection, service_node);
82
83 if (cursor->proto.index_key < k.index_key)
84 pp = &(*pp)->rb_left;
85 else if (cursor->proto.index_key > k.index_key)
86 pp = &(*pp)->rb_right;
87 else
88 goto found_extant_conn;
89 }
90
91 rb_link_node_rcu(&conn->service_node, parent, pp);
92 rb_insert_color(&conn->service_node, &peer->service_conns);
93conn_published:
94 set_bit(RXRPC_CONN_IN_SERVICE_CONNS, &conn->flags);
95 write_sequnlock_bh(&peer->service_conn_lock);
96 _leave(" = %d [new]", conn->debug_id);
97 return;
98
99found_extant_conn:
100 if (atomic_read(&cursor->usage) == 0)
101 goto replace_old_connection;
102 write_sequnlock_bh(&peer->service_conn_lock);
103
104
105
106
107 BUG();
108
109replace_old_connection:
110
111 _debug("replace conn");
112 rb_replace_node_rcu(&cursor->service_node,
113 &conn->service_node,
114 &peer->service_conns);
115 clear_bit(RXRPC_CONN_IN_SERVICE_CONNS, &cursor->flags);
116 goto conn_published;
117}
118
119
120
121
122
123struct rxrpc_connection *rxrpc_prealloc_service_connection(struct rxrpc_net *rxnet,
124 gfp_t gfp)
125{
126 struct rxrpc_connection *conn = rxrpc_alloc_connection(gfp);
127
128 if (conn) {
129
130
131
132 conn->state = RXRPC_CONN_SERVICE_PREALLOC;
133 atomic_set(&conn->usage, 2);
134
135 atomic_inc(&rxnet->nr_conns);
136 write_lock(&rxnet->conn_lock);
137 list_add_tail(&conn->link, &rxnet->service_conns);
138 list_add_tail(&conn->proc_link, &rxnet->conn_proc_list);
139 write_unlock(&rxnet->conn_lock);
140
141 trace_rxrpc_conn(conn, rxrpc_conn_new_service,
142 atomic_read(&conn->usage),
143 __builtin_return_address(0));
144 }
145
146 return conn;
147}
148
149
150
151
152
153void rxrpc_new_incoming_connection(struct rxrpc_sock *rx,
154 struct rxrpc_connection *conn,
155 struct sk_buff *skb)
156{
157 struct rxrpc_skb_priv *sp = rxrpc_skb(skb);
158
159 _enter("");
160
161 conn->proto.epoch = sp->hdr.epoch;
162 conn->proto.cid = sp->hdr.cid & RXRPC_CIDMASK;
163 conn->params.service_id = sp->hdr.serviceId;
164 conn->service_id = sp->hdr.serviceId;
165 conn->security_ix = sp->hdr.securityIndex;
166 conn->out_clientflag = 0;
167 if (conn->security_ix)
168 conn->state = RXRPC_CONN_SERVICE_UNSECURED;
169 else
170 conn->state = RXRPC_CONN_SERVICE;
171
172
173
174
175
176 if (sp->hdr.userStatus == RXRPC_USERSTATUS_SERVICE_UPGRADE &&
177 conn->service_id == rx->service_upgrade.from)
178 conn->service_id = rx->service_upgrade.to;
179
180
181 rxrpc_publish_service_conn(conn->params.peer, conn);
182
183 _net("CONNECTION new %d {%x}", conn->debug_id, conn->proto.cid);
184}
185
186
187
188
189
190void rxrpc_unpublish_service_conn(struct rxrpc_connection *conn)
191{
192 struct rxrpc_peer *peer = conn->params.peer;
193
194 write_seqlock_bh(&peer->service_conn_lock);
195 if (test_and_clear_bit(RXRPC_CONN_IN_SERVICE_CONNS, &conn->flags))
196 rb_erase(&conn->service_node, &peer->service_conns);
197 write_sequnlock_bh(&peer->service_conn_lock);
198}
199