forked from haakonnessjoen/MAC-Telnet
-
Notifications
You must be signed in to change notification settings - Fork 0
/
protocol.h
178 lines (150 loc) · 5.28 KB
/
protocol.h
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
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
/*
Mac-Telnet - Connect to RouterOS or mactelnetd devices via MAC address
Copyright (C) 2010, Håkon Nessjøen <[email protected]>
This program is free software; you can redistribute it and/or modify
it under the terms of the GNU General Public License as published by
the Free Software Foundation; either version 2 of the License, or
(at your option) any later version.
This program is distributed in the hope that it will be useful,
but WITHOUT ANY WARRANTY; without even the implied warranty of
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
GNU General Public License for more details.
You should have received a copy of the GNU General Public License along
with this program; if not, write to the Free Software Foundation, Inc.,
51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*/
#ifndef _MACTELNET_H
#define _MACTELNET_H 1
#define MT_HEADER_LEN 22
#define MT_CPHEADER_LEN 9
#define MT_PACKET_LEN 1500
#define MT_MACTELNET_PORT 20561
#define MT_MNDP_PORT 5678
#define MT_MNDP_MAX_STRING_LENGTH 128
#define MT_MNDP_BROADCAST_INTERVAL 30
#define MT_MNDP_TIMEOUT 5
#define MT_MNDP_LONGTIMEOUT 120
#define MT_SOFTID_MACTELNET "MAC-Telnet"
#ifndef ETH_ALEN
#define ETH_ALEN 6
#endif
#ifndef IPV4_ALEN
#define IPV4_ALEN 4
#endif
/* Packet type */
enum mt_ptype {
MT_PTYPE_SESSIONSTART,
MT_PTYPE_DATA,
MT_PTYPE_ACK,
MT_PTYPE_PING = 4,
MT_PTYPE_PONG,
MT_PTYPE_END = 255
};
/* Control packet type */
enum mt_cptype {
MT_CPTYPE_BEGINAUTH,
MT_CPTYPE_ENCRYPTIONKEY,
MT_CPTYPE_PASSWORD,
MT_CPTYPE_USERNAME,
MT_CPTYPE_TERM_TYPE,
MT_CPTYPE_TERM_WIDTH,
MT_CPTYPE_TERM_HEIGHT,
MT_CPTYPE_PACKET_ERROR,
MT_CPTYPE_END_AUTH = 9,
/* Internal CPTYPE, not part of protocol */
MT_CPTYPE_PLAINDATA = -1
};
/* MNDP attribute type */
enum mt_mndp_attrtype {
MT_MNDPTYPE_ADDRESS = 0x0001,
MT_MNDPTYPE_IDENTITY = 0x0005,
MT_MNDPTYPE_VERSION = 0x0007,
MT_MNDPTYPE_PLATFORM = 0x0008,
MT_MNDPTYPE_TIMESTAMP = 0x000a,
MT_MNDPTYPE_SOFTID = 0x000b,
MT_MNDPTYPE_HARDWARE = 0x000c,
MT_MNDPTYPE_IFNAME = 0x0010
};
/* MNDP packet header */
struct mt_mndp_hdr {
unsigned char version;
unsigned char ttl;
unsigned short cksum;
};
struct mt_mactelnet_hdr {
unsigned char ver;
enum mt_ptype ptype;
unsigned char clienttype[2];
unsigned char srcaddr[6];
unsigned char dstaddr[6];
unsigned short seskey;
unsigned int counter;
unsigned char *data;
};
struct mt_mactelnet_control_hdr {
enum mt_cptype cptype;
unsigned int length;
unsigned char *data;
};
/* TODO: Add all the other information obtainable from mndp */
struct mt_mndp_info {
struct mt_mndp_hdr header;
unsigned char address[ETH_ALEN];
char identity[MT_MNDP_MAX_STRING_LENGTH];
char version[MT_MNDP_MAX_STRING_LENGTH];
char platform[MT_MNDP_MAX_STRING_LENGTH];
char hardware[MT_MNDP_MAX_STRING_LENGTH];
char softid[MT_MNDP_MAX_STRING_LENGTH];
char ifname[MT_MNDP_MAX_STRING_LENGTH];
unsigned int uptime;
};
struct mt_packet {
int size;
unsigned char data[MT_PACKET_LEN];
};
/* MacTelnet/Winbox packets */
extern int init_packet(struct mt_packet *packet, enum mt_ptype ptype, unsigned char *srcmac, unsigned char *dstmac, unsigned short sessionkey, unsigned int counter);
extern int add_control_packet(struct mt_packet *packet, enum mt_cptype cptype, void *cpdata, int data_len);
extern void parse_packet(unsigned char *data, struct mt_mactelnet_hdr *pkthdr);
extern int parse_control_packet(unsigned char *data, int data_len, struct mt_mactelnet_control_hdr *cpkthdr);
/* MAC-Ping packets */
int init_pingpacket(struct mt_packet *packet, unsigned char *srcmac, unsigned char *dstmac);
int init_pongpacket(struct mt_packet *packet, unsigned char *srcmac, unsigned char *dstmac);
int add_packetdata(struct mt_packet *packet, unsigned char *data, unsigned short length);
/* MNDP packets */
extern int mndp_init_packet(struct mt_packet *packet, unsigned char version, unsigned char ttl);
extern int mndp_add_attribute(struct mt_packet *packet, enum mt_mndp_attrtype attrtype, void *attrdata, unsigned short data_len);
extern struct mt_mndp_info *parse_mndp(const unsigned char *data, const int packet_len);
int query_mndp(const char *identity, unsigned char *mac);
int query_mndp_or_mac(char *address, unsigned char *dstmac, int verbose);
/* Number of milliseconds between each retransmission */
#define MAX_RETRANSMIT_INTERVALS 9
static const int retransmit_intervals[MAX_RETRANSMIT_INTERVALS] = { 15, 20, 30, 50, 90, 170, 330, 660, 1000 };
/* Control packet magic header */
static const unsigned char mt_mactelnet_cpmagic[4] = { 0x56, 0x34, 0x12, 0xff };
static const unsigned char mt_mactelnet_clienttype[2] = { 0x00, 0x15 };
/* Must be initialized by application */
extern unsigned char mt_direction_fromserver;
/* Debugging stuff */
#if defined(DEBUG_PROTO)
#ifndef hexdump_defined
void hexdump(const char *title, const void *buf, int len)
{
int i;
unsigned char *data = (unsigned char *)buf;
fprintf(stderr, "%s:\n", title);
for (i = 0; i < len; i++) {
if (!(i & 0xf))
fprintf(stderr, "%04x:", i);
fprintf(stderr, " %02x", data[i]);
if (!(~i & 0xf) || i == len - 1)
fprintf(stderr, "\n");
}
}
#define HEXDUMP(title, buf, len) hexdump(title, buf, len)
#define hexdump_defined
#else
#define HEXDUMP(title, buf, len)
#endif
#endif
#endif