|
@@ -52,72 +52,74 @@ static LIST_HEAD ( net_devices );
|
52
|
52
|
* function takes ownership of the packet buffer.
|
53
|
53
|
*/
|
54
|
54
|
int netdev_tx ( struct net_device *netdev, struct pk_buff *pkb ) {
|
55
|
|
- DBG ( "%s transmitting %p+%zx\n", netdev_name ( netdev ),
|
56
|
|
- pkb->data, pkb_len ( pkb ) );
|
|
55
|
+ int rc;
|
|
56
|
+
|
|
57
|
+ DBGC ( netdev, "NETDEV %p transmitting %p (%p+%zx)\n",
|
|
58
|
+ netdev, pkb, pkb->data, pkb_len ( pkb ) );
|
|
59
|
+
|
|
60
|
+ list_add_tail ( &pkb->list, &netdev->tx_queue );
|
57
|
61
|
|
58
|
62
|
if ( ! ( netdev->state & NETDEV_OPEN ) ) {
|
59
|
|
- free_pkb ( pkb );
|
60
|
|
- return -ENETUNREACH;
|
|
63
|
+ rc = -ENETUNREACH;
|
|
64
|
+ goto err;
|
61
|
65
|
}
|
62
|
|
-
|
63
|
|
- return netdev->transmit ( netdev, pkb );
|
|
66
|
+
|
|
67
|
+ if ( ( rc = netdev->transmit ( netdev, pkb ) ) != 0 )
|
|
68
|
+ goto err;
|
|
69
|
+
|
|
70
|
+ return 0;
|
|
71
|
+
|
|
72
|
+ err:
|
|
73
|
+ DBGC ( netdev, "NETDEV %p transmission %p failed: %s\n",
|
|
74
|
+ netdev, pkb, strerror ( rc ) );
|
|
75
|
+ netdev_tx_complete ( netdev, pkb );
|
|
76
|
+ return rc;
|
64
|
77
|
}
|
65
|
78
|
|
66
|
79
|
/**
|
67
|
|
- * Add packet to receive queue
|
|
80
|
+ * Complete network transmission
|
68
|
81
|
*
|
69
|
82
|
* @v netdev Network device
|
70
|
83
|
* @v pkb Packet buffer
|
71
|
84
|
*
|
72
|
|
- * The packet is added to the network device's RX queue. This
|
73
|
|
- * function takes ownership of the packet buffer.
|
|
85
|
+ * The packet must currently be in the network device's TX queue.
|
74
|
86
|
*/
|
75
|
|
-void netdev_rx ( struct net_device *netdev, struct pk_buff *pkb ) {
|
76
|
|
- DBG ( "%s received %p+%zx\n", netdev_name ( netdev ),
|
77
|
|
- pkb->data, pkb_len ( pkb ) );
|
78
|
|
- list_add_tail ( &pkb->list, &netdev->rx_queue );
|
|
87
|
+void netdev_tx_complete ( struct net_device *netdev, struct pk_buff *pkb ) {
|
|
88
|
+ DBGC ( netdev, "NETDEV %p transmission %p complete\n", netdev, pkb );
|
|
89
|
+
|
|
90
|
+ list_del ( &pkb->list );
|
|
91
|
+ free_pkb ( pkb );
|
79
|
92
|
}
|
80
|
93
|
|
81
|
94
|
/**
|
82
|
|
- * Transmit network-layer packet
|
|
95
|
+ * Complete network transmission
|
83
|
96
|
*
|
84
|
|
- * @v pkb Packet buffer
|
85
|
97
|
* @v netdev Network device
|
86
|
|
- * @v net_protocol Network-layer protocol
|
87
|
|
- * @v ll_dest Destination link-layer address
|
88
|
|
- * @ret rc Return status code
|
89
|
98
|
*
|
90
|
|
- * Prepends link-layer headers to the packet buffer and transmits the
|
91
|
|
- * packet via the specified network device. This function takes
|
92
|
|
- * ownership of the packet buffer.
|
|
99
|
+ * Completes the oldest outstanding packet in the TX queue.
|
93
|
100
|
*/
|
94
|
|
-int net_tx ( struct pk_buff *pkb, struct net_device *netdev,
|
95
|
|
- struct net_protocol *net_protocol, const void *ll_dest ) {
|
96
|
|
- return netdev->ll_protocol->tx ( pkb, netdev, net_protocol, ll_dest );
|
|
101
|
+void netdev_tx_complete_next ( struct net_device *netdev ) {
|
|
102
|
+ struct pk_buff *pkb;
|
|
103
|
+
|
|
104
|
+ list_for_each_entry ( pkb, &netdev->tx_queue, list ) {
|
|
105
|
+ netdev_tx_complete ( netdev, pkb );
|
|
106
|
+ return;
|
|
107
|
+ }
|
97
|
108
|
}
|
98
|
109
|
|
99
|
110
|
/**
|
100
|
|
- * Process received network-layer packet
|
|
111
|
+ * Add packet to receive queue
|
101
|
112
|
*
|
102
|
|
- * @v pkb Packet buffer
|
103
|
113
|
* @v netdev Network device
|
104
|
|
- * @v net_proto Network-layer protocol, in network-byte order
|
105
|
|
- * @v ll_source Source link-layer address
|
106
|
|
- * @ret rc Return status code
|
|
114
|
+ * @v pkb Packet buffer
|
|
115
|
+ *
|
|
116
|
+ * The packet is added to the network device's RX queue. This
|
|
117
|
+ * function takes ownership of the packet buffer.
|
107
|
118
|
*/
|
108
|
|
-int net_rx ( struct pk_buff *pkb, struct net_device *netdev,
|
109
|
|
- uint16_t net_proto, const void *ll_source ) {
|
110
|
|
- struct net_protocol *net_protocol;
|
111
|
|
-
|
112
|
|
- /* Hand off to network-layer protocol, if any */
|
113
|
|
- for ( net_protocol = net_protocols ; net_protocol < net_protocols_end ;
|
114
|
|
- net_protocol++ ) {
|
115
|
|
- if ( net_protocol->net_proto == net_proto ) {
|
116
|
|
- return net_protocol->rx ( pkb, netdev, ll_source );
|
117
|
|
- }
|
118
|
|
- }
|
119
|
|
- free_pkb ( pkb );
|
120
|
|
- return 0;
|
|
119
|
+void netdev_rx ( struct net_device *netdev, struct pk_buff *pkb ) {
|
|
120
|
+ DBGC ( netdev, "NETDEV %p received %p (%p+%zx)\n",
|
|
121
|
+ netdev, pkb, pkb->data, pkb_len ( pkb ) );
|
|
122
|
+ list_add_tail ( &pkb->list, &netdev->rx_queue );
|
121
|
123
|
}
|
122
|
124
|
|
123
|
125
|
/**
|
|
@@ -171,6 +173,7 @@ struct net_device * alloc_netdev ( size_t priv_size ) {
|
171
|
173
|
netdev = calloc ( 1, sizeof ( *netdev ) + priv_size );
|
172
|
174
|
if ( netdev ) {
|
173
|
175
|
INIT_LIST_HEAD ( &netdev->references );
|
|
176
|
+ INIT_LIST_HEAD ( &netdev->tx_queue );
|
174
|
177
|
INIT_LIST_HEAD ( &netdev->rx_queue );
|
175
|
178
|
netdev->priv = ( ( ( void * ) netdev ) + sizeof ( *netdev ) );
|
176
|
179
|
}
|
|
@@ -189,7 +192,8 @@ int register_netdev ( struct net_device *netdev ) {
|
189
|
192
|
|
190
|
193
|
/* Add to device list */
|
191
|
194
|
list_add_tail ( &netdev->list, &net_devices );
|
192
|
|
- DBG ( "%s registered\n", netdev_name ( netdev ) );
|
|
195
|
+ DBGC ( netdev, "NETDEV %p registered as %s\n",
|
|
196
|
+ netdev, netdev_name ( netdev ) );
|
193
|
197
|
|
194
|
198
|
return 0;
|
195
|
199
|
}
|
|
@@ -207,7 +211,7 @@ int netdev_open ( struct net_device *netdev ) {
|
207
|
211
|
if ( netdev->state & NETDEV_OPEN )
|
208
|
212
|
return 0;
|
209
|
213
|
|
210
|
|
- DBG ( "%s opening\n", netdev_name ( netdev ) );
|
|
214
|
+ DBGC ( netdev, "NETDEV %p opening\n", netdev );
|
211
|
215
|
|
212
|
216
|
/* Open the device */
|
213
|
217
|
if ( ( rc = netdev->open ( netdev ) ) != 0 )
|
|
@@ -230,15 +234,20 @@ void netdev_close ( struct net_device *netdev ) {
|
230
|
234
|
if ( ! ( netdev->state & NETDEV_OPEN ) )
|
231
|
235
|
return;
|
232
|
236
|
|
233
|
|
- DBG ( "%s closing\n", netdev_name ( netdev ) );
|
|
237
|
+ DBGC ( netdev, "NETDEV %p closing\n", netdev );
|
234
|
238
|
|
235
|
239
|
/* Close the device */
|
236
|
240
|
netdev->close ( netdev );
|
237
|
241
|
|
|
242
|
+ /* Discard any packets in the TX queue */
|
|
243
|
+ while ( ! list_empty ( &netdev->tx_queue ) ) {
|
|
244
|
+ netdev_tx_complete_next ( netdev );
|
|
245
|
+ }
|
|
246
|
+
|
238
|
247
|
/* Discard any packets in the RX queue */
|
239
|
248
|
while ( ( pkb = netdev_rx_dequeue ( netdev ) ) ) {
|
240
|
|
- DBG ( "%s discarding %p+%zx\n", netdev_name ( netdev ),
|
241
|
|
- pkb->data, pkb_len ( pkb ) );
|
|
249
|
+ DBGC ( netdev, "NETDEV %p discarding received %p\n",
|
|
250
|
+ netdev, pkb );
|
242
|
251
|
free_pkb ( pkb );
|
243
|
252
|
}
|
244
|
253
|
|
|
@@ -263,7 +272,7 @@ void unregister_netdev ( struct net_device *netdev ) {
|
263
|
272
|
|
264
|
273
|
/* Remove from device list */
|
265
|
274
|
list_del ( &netdev->list );
|
266
|
|
- DBG ( "%s unregistered\n", netdev_name ( netdev ) );
|
|
275
|
+ DBGC ( netdev, "NETDEV %p unregistered\n", netdev );
|
267
|
276
|
}
|
268
|
277
|
|
269
|
278
|
/**
|
|
@@ -295,6 +304,48 @@ struct net_device * next_netdev ( void ) {
|
295
|
304
|
return NULL;
|
296
|
305
|
}
|
297
|
306
|
|
|
307
|
+/**
|
|
308
|
+ * Transmit network-layer packet
|
|
309
|
+ *
|
|
310
|
+ * @v pkb Packet buffer
|
|
311
|
+ * @v netdev Network device
|
|
312
|
+ * @v net_protocol Network-layer protocol
|
|
313
|
+ * @v ll_dest Destination link-layer address
|
|
314
|
+ * @ret rc Return status code
|
|
315
|
+ *
|
|
316
|
+ * Prepends link-layer headers to the packet buffer and transmits the
|
|
317
|
+ * packet via the specified network device. This function takes
|
|
318
|
+ * ownership of the packet buffer.
|
|
319
|
+ */
|
|
320
|
+int net_tx ( struct pk_buff *pkb, struct net_device *netdev,
|
|
321
|
+ struct net_protocol *net_protocol, const void *ll_dest ) {
|
|
322
|
+ return netdev->ll_protocol->tx ( pkb, netdev, net_protocol, ll_dest );
|
|
323
|
+}
|
|
324
|
+
|
|
325
|
+/**
|
|
326
|
+ * Process received network-layer packet
|
|
327
|
+ *
|
|
328
|
+ * @v pkb Packet buffer
|
|
329
|
+ * @v netdev Network device
|
|
330
|
+ * @v net_proto Network-layer protocol, in network-byte order
|
|
331
|
+ * @v ll_source Source link-layer address
|
|
332
|
+ * @ret rc Return status code
|
|
333
|
+ */
|
|
334
|
+int net_rx ( struct pk_buff *pkb, struct net_device *netdev,
|
|
335
|
+ uint16_t net_proto, const void *ll_source ) {
|
|
336
|
+ struct net_protocol *net_protocol;
|
|
337
|
+
|
|
338
|
+ /* Hand off to network-layer protocol, if any */
|
|
339
|
+ for ( net_protocol = net_protocols ; net_protocol < net_protocols_end ;
|
|
340
|
+ net_protocol++ ) {
|
|
341
|
+ if ( net_protocol->net_proto == net_proto ) {
|
|
342
|
+ return net_protocol->rx ( pkb, netdev, ll_source );
|
|
343
|
+ }
|
|
344
|
+ }
|
|
345
|
+ free_pkb ( pkb );
|
|
346
|
+ return 0;
|
|
347
|
+}
|
|
348
|
+
|
298
|
349
|
/**
|
299
|
350
|
* Single-step the network stack
|
300
|
351
|
*
|
|
@@ -321,8 +372,8 @@ static void net_step ( struct process *process ) {
|
321
|
372
|
|
322
|
373
|
/* Handle at most one received packet per poll */
|
323
|
374
|
if ( ( pkb = netdev_rx_dequeue ( netdev ) ) ) {
|
324
|
|
- DBG ( "%s processing %p+%zx\n", netdev_name ( netdev ),
|
325
|
|
- pkb->data, pkb_len ( pkb ) );
|
|
375
|
+ DBGC ( netdev, "NETDEV %p processing %p\n",
|
|
376
|
+ netdev, pkb );
|
326
|
377
|
netdev->ll_protocol->rx ( pkb, netdev );
|
327
|
378
|
}
|
328
|
379
|
}
|