1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
|
/*
* Copyright (c) 2023-2025 Ian Marco Moffett and the Osmora Team.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions are met:
*
* 1. Redistributions of source code must retain the above copyright notice,
* this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. Neither the name of Hyra nor the names of its
* contributors may be used to endorse or promote products derived from
* this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
* AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
* LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
#include <sys/types.h>
#include <sys/endian.h>
#include <sys/errno.h>
#include <vm/dynalloc.h>
#include <net/ethertypes.h>
#include <netinet/if_ether.h>
#include <string.h>
struct arp_pkt {
struct ether_frame ehfr;
struct ether_arp payload;
};
static struct arp_pkt *
arp_create(struct netif *nifp, uint32_t *sproto, uint32_t *tproto, uint16_t op)
{
struct arp_pkt *packet;
struct arp_hdr *hdrp;
struct ether_frame *frp;
struct ether_arp *payload;
packet = dynalloc(sizeof(*packet));
if (packet == NULL) {
return NULL;
}
frp = &packet->ehfr;
payload = &packet->payload;
hdrp = &payload->hdr;
/* Ethernet frame, from source to all */
memcpy(frp->ether_saddr, &nifp->addr, ETHER_ADDR_LEN);
memset(frp->ether_daddr, 0xFF, ETHER_ADDR_LEN);
frp->ether_type = swap16(ETHERTYPE_ARP);
/* Now for the ARP header */
hdrp->hw_type = swap16(ARP_HWTYPE_ETHER);
hdrp->proto_type = swap16(ETHERTYPE_IPV4);
hdrp->hw_len = ETHER_ADDR_LEN;
hdrp->proto_len = 4;
hdrp->op_type = swap16(op);
memcpy(payload->sha, frp->ether_saddr, ETHER_ADDR_LEN);
memset(payload->tha, 0xFF, ETHER_ADDR_LEN);
/* Protocol source address */
*((uint32_t *)payload->spa) = *sproto;
*((uint32_t *)payload->tpa) = *tproto;
return packet;
}
static int
arp_send(struct netif *nifp, uint8_t *sproto, uint8_t *tproto, uint16_t op)
{
struct arp_pkt *packet;
struct netbuf nb;
uint32_t *src_tmp, *targ_tmp;
if (nifp->tx_enq == NULL) {
return -ENOTSUP;
}
if (nifp->tx_start == NULL) {
return -ENOTSUP;
}
src_tmp = (uint32_t *)sproto;
targ_tmp = (uint32_t *)tproto;
packet = arp_create(nifp, src_tmp, targ_tmp, op);
if (packet == NULL) {
return -ENOMEM;
}
nb.len = sizeof(*packet);
memcpy(nb.data, packet, nb.len);
nifp->tx_enq(nifp, &nb, NULL);
nifp->tx_start(nifp);
dynfree(packet);
return 0;
}
int
arp_request(struct netif *nifp, uint8_t *sproto, uint8_t *tproto)
{
return arp_send(nifp, sproto, tproto, ARP_REQUEST);
}
int
arp_reply(struct netif *nifp, uint8_t *sproto, uint8_t *tproto)
{
return arp_send(nifp, sproto, tproto, ARP_REPLY);
}
|
