tristan/ZealOS
1
0
Fork 0
mirror of https://github.com/Zeal-Operating-System/ZealOS.git synced 2024-12-29 08:46:31 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions
ZealOS/docs/Home/Net/Drivers/VirtIONet.ZC.html
TomAwezome 48d4f999cb Update documentation.
2021-12-11 06:10:58 -05:00

345 lines
32 KiB
HTML
Executable file
Raw Blame History

<!DOCTYPE HTML>
<html>
<head>
<meta http-equiv="Content-Type" content="text/html;charset=US-ASCII">
<meta name="generator" content="ZealOS V1.07">
<style type="text/css">
body {background-color:#1f1f1f;}
.cF0{color:#e3e3e3;background-color:#1f1f1f;}
.cF1{color:#4f84a6;background-color:#1f1f1f;}
.cF2{color:#73a255;background-color:#1f1f1f;}
.cF3{color:#297582;background-color:#1f1f1f;}
.cF4{color:#b34f4b;background-color:#1f1f1f;}
.cF5{color:#8a52c3;background-color:#1f1f1f;}
.cF6{color:#b7822f;background-color:#1f1f1f;}
.cF7{color:#444444;background-color:#1f1f1f;}
.cF8{color:#6d6d6d;background-color:#1f1f1f;}
.cF9{color:#94bfde;background-color:#1f1f1f;}
.cFA{color:#a1ce97;background-color:#1f1f1f;}
.cFB{color:#6db4be;background-color:#1f1f1f;}
.cFC{color:#e88e88;background-color:#1f1f1f;}
.cFD{color:#ca94e8;background-color:#1f1f1f;}
.cFE{color:#d4b475;background-color:#1f1f1f;}
.cFF{color:#1f1f1f;background-color:#1f1f1f;}
</style>
</head>
<body>
<pre style="font-family:monospace;font-size:12pt">
<a name="l1"></a><span class=cF2>/*</span><span class=cF0>
<a name="l2"></a> </span><span class=cF2>VirtIO Net driver ported from alec's Erythros.</span><span class=cF0>
<a name="l3"></a></span><span class=cF2>*/</span><span class=cF0>
<a name="l4"></a>
<a name="l5"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l6"></a></span><span class=cF2>// PCI virtio I/O registers.</span><span class=cF0>
<a name="l7"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l8"></a>
<a name="l9"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_HOST_FEATURES </span><span class=cFE>0</span><span class=cF0> </span><span class=cF2>// Features supported by the host</span><span class=cF0>
<a name="l10"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_GUEST_FEATURES </span><span class=cFE>4</span><span class=cF0> </span><span class=cF2>// Features activated by the guest</span><span class=cF0>
<a name="l11"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_QUEUE_PFN </span><span class=cFE>8</span><span class=cF0> </span><span class=cF2>// PFN for the currently selected queue</span><span class=cF0>
<a name="l12"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_QUEUE_SIZE </span><span class=cFE>12</span><span class=cF0> </span><span class=cF2>// Queue size for the currently selected queue</span><span class=cF0>
<a name="l13"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_QUEUE_SEL </span><span class=cFE>14</span><span class=cF0> </span><span class=cF2>// Queue selector</span><span class=cF0>
<a name="l14"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_QUEUE_NOTIFY </span><span class=cFE>16</span><span class=cF0> </span><span class=cF2>// Queue notifier</span><span class=cF0>
<a name="l15"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_STATUS </span><span class=cFE>18</span><span class=cF0> </span><span class=cF2>// Device status register</span><span class=cF0>
<a name="l16"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_ISR </span><span class=cFE>19</span><span class=cF0> </span><span class=cF2>// Interrupt status register</span><span class=cF0>
<a name="l17"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_PCI_CONFIG </span><span class=cFE>20</span><span class=cF0> </span><span class=cF2>// Configuration data block</span><span class=cF0>
<a name="l18"></a>
<a name="l19"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l20"></a></span><span class=cF2>// PCI virtio status register bits</span><span class=cF0>
<a name="l21"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l22"></a>
<a name="l23"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_CONFIG_S_ACKNOWLEDGE </span><span class=cFE>1</span><span class=cF0>
<a name="l24"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_CONFIG_S_DRIVER </span><span class=cFE>2</span><span class=cF0>
<a name="l25"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_CONFIG_S_DRIVER_OK </span><span class=cFE>4</span><span class=cF0>
<a name="l26"></a>#</span><span class=cF1>define</span><span class=cF0> VIRTIO_CONFIG_S_FAILED </span><span class=cFE>0x80</span><span class=cF0>
<a name="l27"></a>
<a name="l28"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l29"></a></span><span class=cF2>// Ring descriptor flags</span><span class=cF0>
<a name="l30"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l31"></a>
<a name="l32"></a>#</span><span class=cF1>define</span><span class=cF0> VRING_DESC_F_NEXT </span><span class=cFE>1</span><span class=cF0> </span><span class=cF2>// Buffer continues via the next field</span><span class=cF0>
<a name="l33"></a>#</span><span class=cF1>define</span><span class=cF0> VRING_DESC_F_WRITE </span><span class=cFE>2</span><span class=cF0> </span><span class=cF2>// Buffer is write-only (otherwise read-only)</span><span class=cF0>
<a name="l34"></a>#</span><span class=cF1>define</span><span class=cF0> VRING_DESC_F_INDIRECT </span><span class=cFE>4</span><span class=cF0> </span><span class=cF2>// Buffer contains a list of buffer descriptors</span><span class=cF0>
<a name="l35"></a>
<a name="l36"></a></span><span class=cF1>class</span><span class=cF0> @virtio_queue_buf {
<a name="l37"></a> </span><span class=cF9>U64</span><span class=cF0> address;
<a name="l38"></a> </span><span class=cF9>U32</span><span class=cF0> length;
<a name="l39"></a> </span><span class=cF9>U16</span><span class=cF0> flags;
<a name="l40"></a> </span><span class=cF9>U16</span><span class=cF0> next;
<a name="l41"></a>};
<a name="l42"></a></span><span class=cF1>class</span><span class=cF0> @virtio_avail {
<a name="l43"></a> </span><span class=cF9>U16</span><span class=cF0> flags;
<a name="l44"></a> </span><span class=cF9>U16</span><span class=cF0> index;
<a name="l45"></a> </span><span class=cF9>U16</span><span class=cF0> ring[</span><span class=cFE>256</span><span class=cF0>];
<a name="l46"></a> </span><span class=cF9>U16</span><span class=cF0> int_index;
<a name="l47"></a>};
<a name="l48"></a></span><span class=cF1>class</span><span class=cF0> @virtio_used_item {
<a name="l49"></a> </span><span class=cF9>U32</span><span class=cF0> index;
<a name="l50"></a> </span><span class=cF9>U32</span><span class=cF0> length;
<a name="l51"></a>};
<a name="l52"></a></span><span class=cF1>class</span><span class=cF0> @virtio_used {
<a name="l53"></a> </span><span class=cF9>U16</span><span class=cF0> flags;
<a name="l54"></a> </span><span class=cF9>U16</span><span class=cF0> index;
<a name="l55"></a> @virtio_used_item ring[</span><span class=cFE>256</span><span class=cF0>];
<a name="l56"></a> </span><span class=cF9>U16</span><span class=cF0> int_index;
<a name="l57"></a>};
<a name="l58"></a></span><span class=cF1>class</span><span class=cF0> @virtio_queue {
<a name="l59"></a> @virtio_queue_buf buffers[</span><span class=cFE>256</span><span class=cF0>];
<a name="l60"></a> @virtio_avail available;
<a name="l61"></a> </span><span class=cF1>U8</span><span class=cF0> padding[</span><span class=cFE>3578</span><span class=cF0>];
<a name="l62"></a> @virtio_used used;
<a name="l63"></a>};
<a name="l64"></a>
<a name="l65"></a></span><span class=cF1>class</span><span class=cF0> @virtio_avail_buf {
<a name="l66"></a> </span><span class=cF9>U32</span><span class=cF0> index;
<a name="l67"></a> </span><span class=cF9>U64</span><span class=cF0> address;
<a name="l68"></a> </span><span class=cF9>U32</span><span class=cF0> length;
<a name="l69"></a>};
<a name="l70"></a>
<a name="l71"></a></span><span class=cF1>class</span><span class=cF0> @virtio_buf_info {
<a name="l72"></a> </span><span class=cF1>U8</span><span class=cF0> *buffer;
<a name="l73"></a> </span><span class=cF9>U64</span><span class=cF0> size;
<a name="l74"></a> </span><span class=cF1>U8</span><span class=cF0> flags;
<a name="l75"></a>
<a name="l76"></a> </span><span class=cF2>// If the user wants to keep same buffer as passed in this struct, use &quot;true&quot;.</span><span class=cF0>
<a name="l77"></a> </span><span class=cF2>// otherwise, the supplied buffer will be copied in the queues' buffer</span><span class=cF0>
<a name="l78"></a> </span><span class=cF1>Bool</span><span class=cF0> copy;
<a name="l79"></a>};
<a name="l80"></a>
<a name="l81"></a></span><span class=cF6>&quot;virtio &quot;</span><span class=cF0>;
<a name="l82"></a>
<a name="l83"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l84"></a></span><span class=cF2>// PCI VirtIO Net</span><span class=cF0>
<a name="l85"></a></span><span class=cF2>//</span><span class=cF0>
<a name="l86"></a>
<a name="l87"></a></span><span class=cF9>I64</span><span class=cF0> rx_buffer_ptr = </span><span class=cFE>0</span><span class=cF0>;
<a name="l88"></a></span><span class=cF9>I64</span><span class=cF0> tx_buffer_ptr = </span><span class=cFE>0</span><span class=cF0>;
<a name="l89"></a></span><span class=cF9>I64</span><span class=cF0> rx_buffer_count = </span><span class=cFE>255</span><span class=cF0>;
<a name="l90"></a></span><span class=cF9>I64</span><span class=cF0> tx_buffer_count = </span><span class=cFE>256</span><span class=cF0>;
<a name="l91"></a></span><span class=cF9>U64</span><span class=cF0> rx_buffers = </span><span class=cF5>MAlloc</span><span class=cF0>(ETHERNET_FRAME_SIZE * rx_buffer_count);
<a name="l92"></a></span><span class=cF9>U64</span><span class=cF0> tx_buffers = </span><span class=cF5>MAlloc</span><span class=cF0>(ETHERNET_FRAME_SIZE * tx_buffer_count);
<a name="l93"></a>
<a name="l94"></a></span><span class=cF1>class</span><span class=cF0> @virtio_net {
<a name="l95"></a> </span><span class=cF9>U16</span><span class=cF0> port;
<a name="l96"></a> </span><span class=cF1>U8</span><span class=cF0> mac[</span><span class=cFE>6</span><span class=cF0>];
<a name="l97"></a> @virtio_queue *rq;
<a name="l98"></a> @virtio_queue *sq;
<a name="l99"></a> </span><span class=cF9>I64</span><span class=cF0> rq_size;
<a name="l100"></a> </span><span class=cF9>I64</span><span class=cF0> rq_index;
<a name="l101"></a> </span><span class=cF9>I64</span><span class=cF0> sq_size;
<a name="l102"></a> </span><span class=cF9>I64</span><span class=cF0> sq_index;
<a name="l103"></a> </span><span class=cF9>I64</span><span class=cF0> rx_packets;
<a name="l104"></a> </span><span class=cF9>I64</span><span class=cF0> rx_bytes;
<a name="l105"></a> </span><span class=cF9>I64</span><span class=cF0> tx_packets;
<a name="l106"></a> </span><span class=cF9>I64</span><span class=cF0> tx_bytes;
<a name="l107"></a>};
<a name="l108"></a>
<a name="l109"></a></span><span class=cF1>class</span><span class=cF0> @virtio_net_header {
<a name="l110"></a> </span><span class=cF1>U8</span><span class=cF0> flags;
<a name="l111"></a> </span><span class=cF1>U8</span><span class=cF0> gso_type;
<a name="l112"></a> </span><span class=cF9>U16</span><span class=cF0> header_length;
<a name="l113"></a> </span><span class=cF9>U16</span><span class=cF0> gso_size;
<a name="l114"></a> </span><span class=cF9>U16</span><span class=cF0> checksum_start;
<a name="l115"></a> </span><span class=cF9>U16</span><span class=cF0> checksum_offset;
<a name="l116"></a>};
<a name="l117"></a>
<a name="l118"></a>@virtio_net VirtioNet;
<a name="l119"></a></span><span class=cF5>MemSet</span><span class=cF0>(&amp;VirtioNet, </span><span class=cFE>0</span><span class=cF0>, </span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>@virtio_net</span><span class=cF7>)</span><span class=cF0>);
<a name="l120"></a>
<a name="l121"></a>@virtio_net_header *def_pkt_hdr = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>@virtio_net_header</span><span class=cF7>)</span><span class=cF0>);
<a name="l122"></a>
<a name="l123"></a></span><span class=cF1>static</span><span class=cF0> </span><span class=cF9>I64</span><span class=cF0> @virtio_net_alloc_tx_packet(</span><span class=cF1>U8</span><span class=cF0> **buffer_out, </span><span class=cF9>I64</span><span class=cF0> length</span><span class=cF2>/*, I64 flags*/</span><span class=cF0>) {
<a name="l124"></a> </span><span class=cF2>// FIXME: validate length</span><span class=cF0>
<a name="l125"></a></span><span class=cF2>// flags = flags;</span><span class=cF0>
<a name="l126"></a> </span><span class=cF9>I64</span><span class=cF0> sq_idx = VirtioNet.sq-&gt;available.index % </span><span class=cFE>256</span><span class=cF0>;
<a name="l127"></a> </span><span class=cF9>I64</span><span class=cF0> sq_idx2 = sq_idx % </span><span class=cFE>128</span><span class=cF0>;
<a name="l128"></a> </span><span class=cF9>I64</span><span class=cF0> index = tx_buffer_ptr;
<a name="l129"></a> tx_buffer_ptr = (tx_buffer_ptr + </span><span class=cFE>1</span><span class=cF0>) &amp; (tx_buffer_count - </span><span class=cFE>1</span><span class=cF0>);
<a name="l130"></a> *buffer_out = tx_buffers + index * ETHERNET_FRAME_SIZE;
<a name="l131"></a>
<a name="l132"></a> VirtioNet.sq-&gt;buffers[sq_idx2 * </span><span class=cFE>2</span><span class=cF0>].address = def_pkt_hdr;
<a name="l133"></a> VirtioNet.sq-&gt;buffers[sq_idx2 * </span><span class=cFE>2</span><span class=cF0>].length = </span><span class=cF1>sizeof</span><span class=cF0>(@virtio_net_header);
<a name="l134"></a> VirtioNet.sq-&gt;buffers[sq_idx2 * </span><span class=cFE>2</span><span class=cF0>].flags = VRING_DESC_F_NEXT;
<a name="l135"></a> VirtioNet.sq-&gt;buffers[sq_idx2 * </span><span class=cFE>2</span><span class=cF0>].next = (sq_idx2 * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>;
<a name="l136"></a> VirtioNet.sq-&gt;buffers[(sq_idx2 * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].address = *buffer_out;
<a name="l137"></a> VirtioNet.sq-&gt;buffers[(sq_idx2 * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].length = length;
<a name="l138"></a> VirtioNet.sq-&gt;buffers[(sq_idx2 * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].flags = </span><span class=cF3>NULL</span><span class=cF0>;
<a name="l139"></a> VirtioNet.sq-&gt;buffers[(sq_idx2 * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].next = </span><span class=cFE>0</span><span class=cF0>;
<a name="l140"></a> VirtioNet.sq-&gt;available.ring[sq_idx] = sq_idx2 * </span><span class=cFE>2</span><span class=cF0>;
<a name="l141"></a>
<a name="l142"></a> VirtioNet.sq-&gt;available.index++;
<a name="l143"></a>
<a name="l144"></a> VirtioNet.tx_packets++;
<a name="l145"></a> VirtioNet.tx_bytes += length;
<a name="l146"></a>
<a name="l147"></a> </span><span class=cF1>return</span><span class=cF0> index;
<a name="l148"></a>}
<a name="l149"></a>
<a name="l150"></a></span><span class=cF1>static</span><span class=cF0> </span><span class=cF9>I64</span><span class=cF0> @virtio_net_finish_tx_packet(</span><span class=cF9>I64</span><span class=cF0>) {
<a name="l151"></a> </span><span class=cF5>OutU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_NOTIFY, </span><span class=cFE>1</span><span class=cF0>);
<a name="l152"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
<a name="l153"></a>}
<a name="l154"></a>
<a name="l155"></a></span><span class=cF1>U8</span><span class=cF0> *loopback_frame = </span><span class=cF5>MAlloc</span><span class=cF0>(ETHERNET_FRAME_SIZE);
<a name="l156"></a></span><span class=cF9>I64</span><span class=cF0> loopback_length = </span><span class=cFE>0</span><span class=cF0>;
<a name="l157"></a>
<a name="l158"></a></span><span class=cF9>I64</span><span class=cF0> EthernetFrameAllocate(</span><span class=cF1>U8</span><span class=cF0> **buffer_out, </span><span class=cF1>U8</span><span class=cF0> *src_addr, </span><span class=cF1>U8</span><span class=cF0> *dst_addr,
<a name="l159"></a> </span><span class=cF9>U16</span><span class=cF0> ethertype, </span><span class=cF9>I64</span><span class=cF0> length</span><span class=cF2>/*, I64 flags*/</span><span class=cF0>) {
<a name="l160"></a>
<a name="l161"></a> </span><span class=cF1>U8</span><span class=cF0> *frame;
<a name="l162"></a>
<a name="l163"></a> </span><span class=cF2>// APAD_XMT doesn't seem to work in VirtualBox, so we have to pad the frame</span><span class=cF0>
<a name="l164"></a> </span><span class=cF2>// ourselves</span><span class=cF0>
<a name="l165"></a> </span><span class=cF1>if</span><span class=cF0> (length &lt; </span><span class=cFE>46</span><span class=cF0>)
<a name="l166"></a> length = </span><span class=cFE>46</span><span class=cF0>;
<a name="l167"></a>
<a name="l168"></a> </span><span class=cF9>I64</span><span class=cF0> index;
<a name="l169"></a>
<a name="l170"></a> </span><span class=cF1>if</span><span class=cF0> (!</span><span class=cF5>MemCompare</span><span class=cF7>(</span><span class=cF0>dst_addr, &amp;VirtioNet.mac, </span><span class=cFE>6</span><span class=cF7>)</span><span class=cF0>) </span><span class=cF7>{</span><span class=cF0>
<a name="l171"></a> frame = loopback_frame;
<a name="l172"></a> loopback_length = length;
<a name="l173"></a> index = </span><span class=cF3>I64_MAX</span><span class=cF0>;
<a name="l174"></a> </span><span class=cF7>}</span><span class=cF0> </span><span class=cF1>else</span><span class=cF0> </span><span class=cF7>{</span><span class=cF0>
<a name="l175"></a> index = @virtio_net_alloc_tx_packet(&amp;frame, </span><span class=cFE>14</span><span class=cF0> + length</span><span class=cF2>/*, flags*/</span><span class=cF0>);
<a name="l176"></a> </span><span class=cF1>if</span><span class=cF0> (index &lt; </span><span class=cFE>0</span><span class=cF0>)
<a name="l177"></a> </span><span class=cF1>return</span><span class=cF0> index;
<a name="l178"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l179"></a>
<a name="l180"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(frame + </span><span class=cFE>0</span><span class=cF0>, dst_addr, </span><span class=cFE>6</span><span class=cF0>);
<a name="l181"></a> </span><span class=cF5>MemCopy</span><span class=cF0>(frame + </span><span class=cFE>6</span><span class=cF0>, src_addr, </span><span class=cFE>6</span><span class=cF0>);
<a name="l182"></a> frame[</span><span class=cFE>12</span><span class=cF0>] = (ethertype &gt;&gt; </span><span class=cFE>8</span><span class=cF0>);
<a name="l183"></a> frame[</span><span class=cFE>13</span><span class=cF0>] = (ethertype &amp; </span><span class=cFE>0xff</span><span class=cF0>);
<a name="l184"></a>
<a name="l185"></a> *buffer_out = frame + </span><span class=cFE>14</span><span class=cF0>;
<a name="l186"></a> </span><span class=cF1>return</span><span class=cF0> index;
<a name="l187"></a>}
<a name="l188"></a>
<a name="l189"></a></span><span class=cF9>I64</span><span class=cF0> EthernetFrameFinish(</span><span class=cF9>I64</span><span class=cF0> index) {
<a name="l190"></a> </span><span class=cF1>if</span><span class=cF0> (index == </span><span class=cF3>I64_MAX</span><span class=cF0> &amp;&amp; loopback_frame &amp;&amp; loopback_length) </span><span class=cF7>{</span><span class=cF0>
<a name="l191"></a> NetQueuePush(loopback_frame, loopback_length);
<a name="l192"></a> loopback_length = </span><span class=cFE>0</span><span class=cF0>;
<a name="l193"></a> </span><span class=cF1>return</span><span class=cF0> </span><span class=cFE>0</span><span class=cF0>;
<a name="l194"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l195"></a> </span><span class=cF1>return</span><span class=cF0> @virtio_net_finish_tx_packet(index);
<a name="l196"></a>}
<a name="l197"></a>
<a name="l198"></a></span><span class=cF1>U8</span><span class=cF0> *EthernetMACGet() { </span><span class=cF1>return</span><span class=cF0> &amp;VirtioNet.mac; }
<a name="l199"></a>
<a name="l200"></a></span><span class=cF9>I64</span><span class=cF0> @virtio_net_init() {
<a name="l201"></a> </span><span class=cF9>I64</span><span class=cF0> i, j;
<a name="l202"></a>
<a name="l203"></a> </span><span class=cF2>// Scan for device</span><span class=cF0>
<a name="l204"></a> j = </span><span class=cF5>PCIClassFind</span><span class=cF0>(</span><span class=cFE>0x020000</span><span class=cF0>, </span><span class=cFE>0</span><span class=cF0>);
<a name="l205"></a> </span><span class=cF1>if</span><span class=cF0> (j &lt; </span><span class=cFE>0</span><span class=cF0>) </span><span class=cF7>{</span><span class=cF0>
<a name="l206"></a> </span><span class=cF6>&quot;\nVirtio-net device not found.\n&quot;</span><span class=cF0>;
<a name="l207"></a> </span><span class=cF1>return</span><span class=cF0> -</span><span class=cFE>1</span><span class=cF0>;
<a name="l208"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l209"></a> VirtioNet.port = </span><span class=cF5>PCIReadU32</span><span class=cF0>(j.u8[</span><span class=cFE>2</span><span class=cF0>], j.u8[</span><span class=cFE>1</span><span class=cF0>], j.u8[</span><span class=cFE>0</span><span class=cF0>], </span><span class=cFE>0x10</span><span class=cF0>) &amp; </span><span class=cFE>0xFFFFFFFC</span><span class=cF0>;
<a name="l210"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i &lt; </span><span class=cFE>6</span><span class=cF0>; i++) </span><span class=cF7>{</span><span class=cF0>
<a name="l211"></a> VirtioNet.mac[i] = </span><span class=cF5>InU8</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_CONFIG + i);
<a name="l212"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l213"></a>
<a name="l214"></a> </span><span class=cF2>// Reset Device</span><span class=cF0>
<a name="l215"></a> </span><span class=cF5>OutU8</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_STATUS, </span><span class=cFE>0</span><span class=cF0>);
<a name="l216"></a>
<a name="l217"></a> </span><span class=cF2>// Found Driver</span><span class=cF0>
<a name="l218"></a> </span><span class=cF5>OutU8</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_STATUS,
<a name="l219"></a> </span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>VirtioNet.port + VIRTIO_PCI_STATUS</span><span class=cF7>)</span><span class=cF0> | VIRTIO_CONFIG_S_ACKNOWLEDGE |
<a name="l220"></a> VIRTIO_CONFIG_S_DRIVER);
<a name="l221"></a>
<a name="l222"></a> </span><span class=cF2>// Set up receive queue</span><span class=cF0>
<a name="l223"></a> </span><span class=cF5>OutU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_SEL, </span><span class=cFE>0</span><span class=cF0>);
<a name="l224"></a> VirtioNet.rq_size = </span><span class=cF5>InU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_SIZE); </span><span class=cF2>// 256</span><span class=cF0>
<a name="l225"></a> VirtioNet.rq = </span><span class=cF5>CAllocAligned</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>@virtio_queue</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFE>4096</span><span class=cF0>, </span><span class=cF5>Fs</span><span class=cF0>-&gt;code_heap);
<a name="l226"></a> </span><span class=cF5>OutU32</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_PFN, VirtioNet.rq / </span><span class=cFE>4096</span><span class=cF0>);
<a name="l227"></a>
<a name="l228"></a> </span><span class=cF2>// Set up send queue</span><span class=cF0>
<a name="l229"></a> </span><span class=cF5>OutU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_SEL, </span><span class=cFE>1</span><span class=cF0>);
<a name="l230"></a> VirtioNet.sq_size = </span><span class=cF5>InU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_SIZE); </span><span class=cF2>// 256</span><span class=cF0>
<a name="l231"></a> VirtioNet.sq = </span><span class=cF5>CAllocAligned</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>@virtio_queue</span><span class=cF7>)</span><span class=cF0>, </span><span class=cFE>4096</span><span class=cF0>, </span><span class=cF5>Fs</span><span class=cF0>-&gt;code_heap);
<a name="l232"></a> </span><span class=cF5>OutU32</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_PFN, VirtioNet.sq / </span><span class=cFE>4096</span><span class=cF0>);
<a name="l233"></a>
<a name="l234"></a> </span><span class=cF1>for</span><span class=cF0> (i = </span><span class=cFE>0</span><span class=cF0>; i &lt; </span><span class=cFE>128</span><span class=cF0>; i++) </span><span class=cF7>{</span><span class=cF0>
<a name="l235"></a> VirtioNet.rq-&gt;buffers[i * </span><span class=cFE>2</span><span class=cF0>].address = </span><span class=cF5>CAlloc</span><span class=cF0>(</span><span class=cF1>sizeof</span><span class=cF7>(</span><span class=cF0>@virtio_net_header</span><span class=cF7>)</span><span class=cF0>);
<a name="l236"></a> VirtioNet.rq-&gt;buffers[i * </span><span class=cFE>2</span><span class=cF0>].length = </span><span class=cF1>sizeof</span><span class=cF0>(@virtio_net_header);
<a name="l237"></a> VirtioNet.rq-&gt;buffers[i * </span><span class=cFE>2</span><span class=cF0>].flags = VRING_DESC_F_NEXT | VRING_DESC_F_WRITE;
<a name="l238"></a> VirtioNet.rq-&gt;buffers[i * </span><span class=cFE>2</span><span class=cF0>].next = (i * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>;
<a name="l239"></a> VirtioNet.rq-&gt;buffers[(i * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].address = </span><span class=cF5>CAlloc</span><span class=cF0>(ETHERNET_FRAME_SIZE);
<a name="l240"></a> VirtioNet.rq-&gt;buffers[(i * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].length = ETHERNET_FRAME_SIZE;
<a name="l241"></a> VirtioNet.rq-&gt;buffers[(i * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].flags = VRING_DESC_F_WRITE;
<a name="l242"></a> VirtioNet.rq-&gt;buffers[(i * </span><span class=cFE>2</span><span class=cF0>) + </span><span class=cFE>1</span><span class=cF0>].next = </span><span class=cFE>0</span><span class=cF0>;
<a name="l243"></a> VirtioNet.rq-&gt;available.ring[i] = i * </span><span class=cFE>2</span><span class=cF0>;
<a name="l244"></a> VirtioNet.rq-&gt;available.ring[i + </span><span class=cFE>128</span><span class=cF0>] = i * </span><span class=cFE>2</span><span class=cF0>;
<a name="l245"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l246"></a> VirtioNet.rq-&gt;available.index = </span><span class=cFE>1</span><span class=cF0>;
<a name="l247"></a>
<a name="l248"></a> </span><span class=cF2>// Init OK</span><span class=cF0>
<a name="l249"></a> </span><span class=cF5>OutU8</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_STATUS,
<a name="l250"></a> </span><span class=cF5>InU8</span><span class=cF7>(</span><span class=cF0>VirtioNet.port + VIRTIO_PCI_STATUS</span><span class=cF7>)</span><span class=cF0> | VIRTIO_CONFIG_S_DRIVER_OK);
<a name="l251"></a> </span><span class=cF5>OutU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_NOTIFY, </span><span class=cFE>0</span><span class=cF0>);
<a name="l252"></a> </span><span class=cF6>&quot;\x1b[33mVirtio-net device detected, MAC address &quot;</span><span class=cF0>
<a name="l253"></a> </span><span class=cF6>&quot;%02x:%02x:%02x:%02x:%02x:%02x\x1b[0m\n&quot;</span><span class=cF0>,
<a name="l254"></a> VirtioNet.mac[</span><span class=cFE>0</span><span class=cF0>], VirtioNet.mac[</span><span class=cFE>1</span><span class=cF0>], VirtioNet.mac[</span><span class=cFE>2</span><span class=cF0>], VirtioNet.mac[</span><span class=cFE>3</span><span class=cF0>],
<a name="l255"></a> VirtioNet.mac[</span><span class=cFE>4</span><span class=cF0>], VirtioNet.mac[</span><span class=cFE>5</span><span class=cF0>];
<a name="l256"></a>}
<a name="l257"></a>
<a name="l258"></a></span><span class=cF6>&quot;virtio-net &quot;</span><span class=cF0>;
<a name="l259"></a>@virtio_net_init;
<a name="l260"></a>
<a name="l261"></a></span><span class=cF2>/*</span><span class=cF0>
<a name="l262"></a></span><span class=cF2>U0 @virtio_net_handle_net_fifo_entry(CNetFifoEntry *e) {</span><span class=cF0>
<a name="l263"></a></span><span class=cF2> CEthFrame l2_frame;</span><span class=cF0>
<a name="l264"></a>
<a name="l265"></a></span><span class=cF2> if (EthernetFrameParse(&amp;l2_frame, e-&gt;frame, e-&gt;length) &lt; 0)</span><span class=cF0>
<a name="l266"></a></span><span class=cF2> return;</span><span class=cF0>
<a name="l267"></a>
<a name="l268"></a></span><span class=cF2> CL3Protocol *l3 = l3_protocols;</span><span class=cF0>
<a name="l269"></a>
<a name="l270"></a></span><span class=cF2> while (l3) {</span><span class=cF0>
<a name="l271"></a></span><span class=cF2> if (l3-&gt;ethertype == l2_frame.ethertype) {</span><span class=cF0>
<a name="l272"></a></span><span class=cF2> l3-&gt;handler(&amp;l2_frame);</span><span class=cF0>
<a name="l273"></a></span><span class=cF2> break;</span><span class=cF0>
<a name="l274"></a></span><span class=cF2> }</span><span class=cF0>
<a name="l275"></a></span><span class=cF2> l3 = l3-&gt;next;</span><span class=cF0>
<a name="l276"></a></span><span class=cF2> }</span><span class=cF0>
<a name="l277"></a></span><span class=cF2>}</span><span class=cF0>
<a name="l278"></a></span><span class=cF2>*/</span><span class=cF0>
<a name="l279"></a></span><span class=cF1>U0</span><span class=cF0> @virtio_net_handler_task() {
<a name="l280"></a> </span><span class=cF9>I64</span><span class=cF0> idx_used, idx_rec;
<a name="l281"></a> </span><span class=cF9>I64</span><span class=cF0> i, j;
<a name="l282"></a> @virtio_used_item *item;
<a name="l283"></a> </span><span class=cF1>U8</span><span class=cF0> *buffer;
<a name="l284"></a> </span><span class=cF9>I64</span><span class=cF0> length;
<a name="l285"></a> </span><span class=cF1>while</span><span class=cF0> (</span><span class=cFE>1</span><span class=cF0>) </span><span class=cF7>{</span><span class=cF0>
<a name="l286"></a> idx_rec = VirtioNet.rq_index;
<a name="l287"></a> idx_used = VirtioNet.rq-&gt;used.index;
<a name="l288"></a>
<a name="l289"></a> </span><span class=cF1>if</span><span class=cF0> (idx_used &lt; idx_rec) {
<a name="l290"></a> idx_used += </span><span class=cFE>0x10000</span><span class=cF0>;
<a name="l291"></a> }
<a name="l292"></a>
<a name="l293"></a> </span><span class=cF1>if</span><span class=cF0> (idx_rec != idx_used &amp;&amp; idx_used) {
<a name="l294"></a>
<a name="l295"></a> j = </span><span class=cFE>0</span><span class=cF0>;
<a name="l296"></a> </span><span class=cF1>for</span><span class=cF0> (i = idx_rec; i &lt; idx_used; i++) </span><span class=cF7>{</span><span class=cF0>
<a name="l297"></a> item = VirtioNet.rq-&gt;used.ring;
<a name="l298"></a> buffer = VirtioNet.rq-&gt;buffers[item[i % </span><span class=cFE>256</span><span class=cF0>].index + </span><span class=cFE>1</span><span class=cF0>];
<a name="l299"></a> length = item[i % </span><span class=cFE>256</span><span class=cF0>].length;
<a name="l300"></a> NetQueuePush(buffer, length - </span><span class=cFE>10</span><span class=cF0>);
<a name="l301"></a> j++;
<a name="l302"></a> VirtioNet.rx_packets++;
<a name="l303"></a> VirtioNet.rx_bytes += length - </span><span class=cFE>10</span><span class=cF0>;
<a name="l304"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l305"></a> VirtioNet.rq_index = idx_used % </span><span class=cFE>0x10000</span><span class=cF0>;
<a name="l306"></a> VirtioNet.rq-&gt;available.index += j;
<a name="l307"></a> </span><span class=cF5>OutU16</span><span class=cF0>(VirtioNet.port + VIRTIO_PCI_QUEUE_NOTIFY, </span><span class=cFE>0</span><span class=cF0>);
<a name="l308"></a> }
<a name="l309"></a> CNetQueueEntry *e = NetQueuePull;
<a name="l310"></a> </span><span class=cF1>if</span><span class=cF0> (e) {
<a name="l311"></a></span><span class=cF2>// @virtio_net_handle_net_fifo_entry(e);</span><span class=cF0>
<a name="l312"></a> }
<a name="l313"></a> </span><span class=cF5>Sleep</span><span class=cF0>(</span><span class=cFE>30</span><span class=cF0>);
<a name="l314"></a> </span><span class=cF7>}</span><span class=cF0>
<a name="l315"></a>}
<a name="l316"></a>
<a name="l317"></a></span><span class=cF5>Spawn</span><span class=cF0>(&amp;@virtio_net_handler_task,, </span><span class=cF6>&quot;Virtio-net&quot;</span><span class=cF0>);</span></pre></body>
</html>
Reference in a new issue View git blame Copy permalink