| 1 | 1 |
new file mode 100644 |
| ... | ... |
@@ -0,0 +1,59 @@ |
| 1 |
+#include "src/lib.h" |
|
| 2 |
+ |
|
| 3 |
+int send_wol(const char *interface, unsigned char *buf, int len) {
|
|
| 4 |
+ struct sockaddr_ll sll; |
|
| 5 |
+ struct ifreq ifr; |
|
| 6 |
+ int sock, arp_source_ip, arp_target_ip; |
|
| 7 |
+ |
|
| 8 |
+ if((sock = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL))) < 0) {
|
|
| 9 |
+ perror("socket");
|
|
| 10 |
+ return 1; |
|
| 11 |
+ } |
|
| 12 |
+ |
|
| 13 |
+ memset(&ifr, 0x00, sizeof(ifr)); |
|
| 14 |
+ |
|
| 15 |
+ strcpy(ifr.ifr_name, interface); |
|
| 16 |
+ if(ioctl(sock, SIOCGIFINDEX, &ifr) < 0 ) {
|
|
| 17 |
+ perror("ioctl ");
|
|
| 18 |
+ return 1; |
|
| 19 |
+ } |
|
| 20 |
+ |
|
| 21 |
+ memset(&sll, 0x00, sizeof(sll)); |
|
| 22 |
+ sll.sll_family = PF_PACKET; |
|
| 23 |
+ sll.sll_ifindex = ifr.ifr_ifindex; |
|
| 24 |
+ sll.sll_protocol = htons(ETH_P_ALL); |
|
| 25 |
+ |
|
| 26 |
+ if(sendto(sock, buf, len, 0, |
|
| 27 |
+ (struct sockaddr *)&sll, sizeof(sll)) < 0) {
|
|
| 28 |
+ |
|
| 29 |
+ perror("sendto ");
|
|
| 30 |
+ } |
|
| 31 |
+ |
|
| 32 |
+ return 0; |
|
| 33 |
+} |
|
| 34 |
+ |
|
| 35 |
+void make_ether_packet(char *buf, const char *dstmac) {
|
|
| 36 |
+ struct ether_header *ether_header = (struct ether_header *)buf; |
|
| 37 |
+ const char broadmac[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
|
|
| 38 |
+ const char srcmac[6] = {0x00, 0x90, 0x27, 0x85, 0xcf, 0x01};
|
|
| 39 |
+ |
|
| 40 |
+ memcpy(ether_header->ether_dhost, broadmac, 6); |
|
| 41 |
+ memcpy(ether_header->ether_shost, srcmac, 6); |
|
| 42 |
+ |
|
| 43 |
+ ether_header->ether_type = htons(0x0842); |
|
| 44 |
+} |
|
| 45 |
+ |
|
| 46 |
+void make_wol_packet(char *buf, const char *dstmac) {
|
|
| 47 |
+ int offset = 0; |
|
| 48 |
+ const char broadmac[6] = {0xff, 0xff, 0xff, 0xff, 0xff, 0xff};
|
|
| 49 |
+ |
|
| 50 |
+ memcpy(buf, broadmac, sizeof(broadmac)); |
|
| 51 |
+ |
|
| 52 |
+ offset += sizeof(broadmac); |
|
| 53 |
+ |
|
| 54 |
+ for (int i=0; i<16; i++) {
|
|
| 55 |
+ memcpy(buf + offset, dstmac, 6); |
|
| 56 |
+ |
|
| 57 |
+ offset += 6; |
|
| 58 |
+ } |
|
| 59 |
+} |