[ViewVC] Annotation of: cvs/wvsniff/wvsniff

#!/usr/bin/perl

use Event;
use Time::HiRes qw(time);
use Curses;
use Socket;
use GPS;

my $GPS = eval { new GPS };

$DEV    = "eth1";
$RAWDEV = "wifi0";
$PROC   = "/proc/driver/aironet/$DEV";

$SIG{INT} =
$SIG{TERM} =
$SIG{HUP} = sub { exit };

sub config {
    open my $config, ">$PROC/Config"
       or die "$PROC/Config: $!";
    print $config $_[0];
}

config "Mode: yna\n";
system "ifconfig", $DEV, "up";
system "ifconfig", $RAWDEV, "up";

my $initscr;
sub init_screen {
   initscr;
   $initscr = 1;
   start_color;
   cbreak; noecho;
   immedok 0; nonl; raw; intrflush 0; keypad 1;
   idlok 1; scrollok 0; leaveok 0;
}

sub end_win {
   endwin if $initscr--;
}

init_screen;

sub signal_quality {
   open my $stats, "<", "$PROC/Status"
      or return 0;
   sysread $stats, $buf, 1024;
   $buf =~ /Signal Quality: (\d+)/ && $1;
}

my $refresh = Event->idle(nice => -5, parked => 1, min => 0.01, max => 1, repeat => 0, cb => sub {
   @menu = ();
   &$curmenu;

   $menu_idx += @menu if $menu_idx < 0;
   $menu_idx -= @menu if $menu_idx >= @menu;

   erase;

   my $data = $GPS ? $GPS->data : {};

   move 0, 0;
   addstr $frame++ . ": " . signal_quality . " " . localtime($data->{time}) . "     $data->{lat} $data->{long}     $data->{alt}m";

   for my $idx (0 .. $#menu) {
      move 2 + $idx, 0;
      standout if $idx == $menu_idx;
      addstr $menu[$idx][0];
      standend if $idx == $menu_idx;
   }

   move 3 + scalar@menu, 0;
   eval {
      $menu[$menu_idx][1]->();
   };

   refresh;
});

Event->io(fd => \*STDIN, poll => 'r', cb => sub {
   my $ch = getch;
   if ($ch eq "\x1b" or $ch eq "q") {
      Event::unloop;
   } elsif ($ch eq KEY_DOWN or $ch eq "j") {
      $menu_idx++;
   } elsif ($ch eq KEY_UP or $ch eq "k") {
      $menu_idx--;
   } else {
      eval {
         $menu[$menu_idx][2]->($ch);
      };
   }
   $refresh->start;
});

END {
   end_win;
   config "Mode: adhoc\n";
}

sub decode_tags {
   my $pkt = shift;
   my %tag;

   while ($pkt) {
      my ($id, $len) = unpack "C C", $pkt;
      my $data = substr $pkt, 2, $len;
      $pkt = substr $pkt, 2 + $len;

      $id = ({
                0 => SSID,
                1 => rates,
                2 => FH,
                3 => DS,
                4 => CF,
                5 => TIM,
                6 => IBSS,
               16 => challenge,
            })->{$id};
      $tag{$id} = $data;
   }
   
   %tag;
}

sub PF_PACKET (){     17 }
sub SOCK_RAW  (){      3 }
sub ETH_P_ALL (){ 0x0003 }
sub SIOCGIFINDEX (){ 0x000008933 }

sub open_pcap_socket {
   socket my $cap, PF_PACKET, SOCK_RAW, (unpack "s", pack "n", ETH_P_ALL)
      or die "unable to open packet socket: $!";

   my $ifidx = pack "a16 I", $RAWDEV;
   ioctl $cap, SIOCGIFINDEX, $ifidx
      or die "can't get index of interface $RAWDEV: $!";
   $ifidx = unpack "x16 I", $ifidx;

   bind $cap, pack "S! S! I S! C C a8", PF_PACKET, (unpack "s", pack "n", ETH_P_ALL), $ifidx
      or die "unable to bind to interface: $!";

   $cap;
}

sub e2h($) {
   join ":", map unpack("H*", $_), split //, $_[0];
}

sub add_menu {
   my ($title, $display, $select) = @_;
   push @menu, [$title, $display, $select];
}

$curmenu = \&menu_bss_list;

sub bss2string {
   my $bss = shift;

   my $s = "AGE(" . int(time - $bss->{ts}) . ") "
           . "IP($bss->{ip}) "
           . "ARP($bss->{arp}) ";
   while (my ($k, $v) = each %{$bss->{ap}}) {
      $s .= "(" . e2h($k) . " $v->{mode} '$v->{essid}') ";
   }
   $s;
}

sub show_map {
   my ($map, $w, $h) = @_;

   my $data = $GPS->data;

   local $map->{"$data->{lat};$data->{long}"} = 0;

   my @data = (("-" x $w) x $h);

   my ($x1, $y1, $x2, $y2) = (1e6, 1e6, 1e-6, 1e-6);
   my $level = 1;

   while (my ($k, $v) = each %$map) {
      my ($y, $x) = split /;/, $k;
      $x1 = $x if $x1 > $x;
      $x2 = $x if $x2 < $x;
      $y1 = $y if $y1 > $y;
      $y2 = $y if $y2 < $y;
      $level = $v if $level < $v;
   }

   $x2 = ($w - 1) / (($x2 - $x1) || 1e-6);
   $y2 = ($h - 1) / (($y2 - $y1) || 1e-6);

   while (my ($k, $v) = each %$map) {
      my ($y, $x) = split /;/, $k;

      $y = ($y - $y1) * $y2;
      $x = ($x - $x1) * $x2;

      substr $data[$y], $x, 1, int($map->{$k} * 9 / $level);
   }

   for (@data) {
      addstr $_ . "\n";
   }
}

sub display_bss {
   my $bss = shift;

   addstr "TS: $bss->{ts}\n";
   addstr "WEP/Weak packets received: $bss->{wep}/$bss->{weak}\n";
   addstr "ARP/IP packets received: $bss->{arp}/$bss->{ip}\n";

   addstr "\naccess points\n";

   while (my ($k, $v) = each %{$bss->{ap}}) {
      addstr "   " . e2h($k) . "\n";
      addstr "       mode $v->{mode}; channel $v->{channel}; essid '$v->{essid}'; beacon frames $v->{beacon}\n";
   }

   addstr "\nstations\n";

   while (my ($k, $v) = each %{$bss->{station}}) {
      addstr "   " . e2h($k);
      while (my ($k, $v) = each %$v) {
         addstr " " . (inet_ntoa $k) . "($v)";
      }
      addstr "\n";
   }

   if ($bss->{gps}) {
      my ($x, $y); getyx $y, $x;
      addstr "\nmap\n";
      my $h = (&getmaxy - $y) - 3;
      show_map $bss->{gps}, int($h*1.8), $h;
   }
}

sub menu_bss_list {
   my @menu;
   while (my ($k, $v) = each %$db) {
      add_menu e2h($k) . " " . bss2string($v),
               sub { display_bss $v },
               sub {
                  if ($_[0] eq KEY_LEFT or $_[0] eq "h") {
                     Event::unloop;
                  } elsif ($_[0] eq KEY_RIGHT or $_[0] eq "l") {
                     #$curmenu = sub { display_bss $k };
                  }
               };
   }
}

sub activity {
   if ($GPS) {
      my $data = $GPS->data;
      $db->{$_[0]}{gps}{"$data->{lat};$data->{long}"} = signal_quality;
   }
   $db->{$_[0]}->{ts} = time;
   $refresh->start;
}

sub reg_ip {
   my ($bssid, $ip, $ether) = @_;
   $db->{$bssid}{station}{$ether}{$ip}++;
   activity $bssid;
}

{
   my $cap = open_pcap_socket;
   my $pkt;

   Event->io(fd => $cap, poll => 'r', cb => sub {
      sysread $$cap, $pkt, 120;

      my ($fc1, $fc2, $sid, $a1, $a2, $a3, $sc, $pkt)
         = unpack "C C n a6 a6 a6 S a*", $pkt;

      $pkt = substr $pkt, 6 if $fc2 & 0x03 == 0x03; # skip A4

      if ($fc1 == 0x80 or $fc1 == 0x50) {
         my ($ts1, $ts2, $bi, $cf, $pkt)
            = unpack "L L S S a*", $pkt;

         my %tag = decode_tags $pkt;

         my $ap = $db->{$a3}{ap}{$a2} ||= {};
         $ap->{mode} = ($cf & 3) == 1 ? "AP" : "adhoc";
         $ap->{essid} = $tag{SSID};
         $ap->{channel} = ord $tag{DS};
         $ap->{beacon}++;

         activity $a3;
      } elsif ($fc1 == 0x08) {
         my $bssid = ($a3, $a2, $a1)[$fc2 & 3];

         if ($fc2 & 0x40) {
            my ($iv1, $iv2, $iv3, $ivopt, $byte) = unpack "C C C C C", $pkt;
            $db->{$bssid}{wep}++;
            if ($iv1 > 2 and $iv1 < 14 and $iv2 == 255) {
               $db->{$bssid}{weak}++;
            }
         } else {
            my ($llc, $et, $pkt) = unpack "a6 n a*", $pkt;
            if ($llc eq "\xaa\xaa\x03\x00\x00\x00") { # SNAP/UI/ENCAP_ETHER
               if ($et == 0x0800) {
                  my ($vhl, $tos, $len, $id, $off, $ttl, $prot, $sum, $src, $dst, $pkt)
                     = unpack "C C n n n C C n a4 a4 a*", $pkt;
                  if ($vhl & 0x40 == 0x40) {
                     $db->{$bssid}{ip}++;
                     reg_ip $bssid, $src, $a2;
                     reg_ip $bssid, $dst, $a1;
                     0 &&
                     printf "IP: %02x %02x %04x %04x: %s %s> %s %s %02x \n",
                            $fc1, $fc2, $sid, $sc,
                            (unpack "H*", $a2), (inet_ntoa $src),
                            (unpack "H*", $a1), (inet_ntoa $dst),
                            $prot;
                  }
               } elsif ($et == 0x0806) {
                  my ($hrd, $pro, $hln, $pln, $op, $src_hw, $src, $dst_hw, $dst)
                     = unpack "n n C C n a6 a4 a6 a4", $pkt;
                  if ($hrd == 1 and $hln == 6 and $pln == 4) {
                     reg_ip $bssid, $src, $src_hw;
                     reg_ip $bssid, $dst, $dst_hw if $op != 1;
                     $db->{$bssid}{arp}++;
                     0 &&
                     printf "ARP: %04x> %s %s : %s %s\n",
                            $op,
                            (unpack "H*", $src_hw), (inet_ntoa $src),
                            (unpack "H*", $dst_hw), (inet_ntoa $dst);
                  }
               }
            } else {
               0 &&
               printf "?? %02x %02x %04x %04x: %s.%s \n", $fc1, $fc2, $sid, $sc, (unpack "H*", $llc), unpack "H*", $pkt;
            }
         }
      } elsif ($fc1 != 0x40 and $fc1 != 0x10 and $fc1 != 0x00 and $fc1 != 0xb0) {
         0 &&
         printf "%02x %02x %04x %04x: %s \n", $fc1, $fc2, $sid, $sc, unpack "H*", $pkt;
      }
   });
}

Event::loop;


Revision:	1.6
Committed:	Fri Apr 26 23:38:00 2002 UTC (22 years, 1 month ago) by root
Branch:	MAIN
Changes since 1.5:	+25 -5 lines
Log Message:	* empty log message *
#	User	Rev	Content
1	root	1.1	#!/usr/bin/perl
2
3			use Event;
4			use Time::HiRes qw(time);
5			use Curses;
6			use Socket;
7	root	1.2	use GPS;
8
9			my $GPS = eval { new GPS };
10	root	1.1
11			$DEV = "eth1";
12			$RAWDEV = "wifi0";
13			$PROC = "/proc/driver/aironet/$DEV";
14
15			$SIG{INT} =
16			$SIG{TERM} =
17			$SIG{HUP} = sub { exit };
18
19			sub config {
20			open my $config, ">$PROC/Config"
21			or die "$PROC/Config: $!";
22			print $config $_[0];
23			}
24
25			config "Mode: yna\n";
26			system "ifconfig", $DEV, "up";
27			system "ifconfig", $RAWDEV, "up";
28
29			my $initscr;
30			sub init_screen {
31			initscr;
32			$initscr = 1;
33			start_color;
34			cbreak; noecho;
35			immedok 0; nonl; raw; intrflush 0; keypad 1;
36			idlok 1; scrollok 0; leaveok 0;
37			}
38
39			sub end_win {
40			endwin if $initscr--;
41			}
42
43			init_screen;
44
45	root	1.6	sub signal_quality {
46			open my $stats, "<", "$PROC/Status"
47			or return 0;
48			sysread $stats, $buf, 1024;
49			$buf =~ /Signal Quality: (\d+)/ && $1;
50			}
51
52	root	1.1	my $refresh = Event->idle(nice => -5, parked => 1, min => 0.01, max => 1, repeat => 0, cb => sub {
53			@menu = ();
54			&$curmenu;
55
56			$menu_idx += @menu if $menu_idx < 0;
57			$menu_idx -= @menu if $menu_idx >= @menu;
58
59			erase;
60
61	root	1.5	my $data = $GPS ? $GPS->data : {};
62	root	1.2
63	root	1.1	move 0, 0;
64	root	1.6	addstr $frame++ . ": " . signal_quality . " " . localtime($data->{time}) . " $data->{lat} $data->{long} $data->{alt}m";
65	root	1.1
66			for my $idx (0 .. $#menu) {
67	root	1.3	move 2 + $idx, 0;
68	root	1.1	standout if $idx == $menu_idx;
69			addstr $menu[$idx][0];
70			standend if $idx == $menu_idx;
71			}
72
73	root	1.3	move 3 + scalar@menu, 0;
74	root	1.1	eval {
75			$menu[$menu_idx][1]->();
76			};
77
78			refresh;
79			});
80
81			Event->io(fd => \*STDIN, poll => 'r', cb => sub {
82			my $ch = getch;
83			if ($ch eq "\x1b" or $ch eq "q") {
84			Event::unloop;
85			} elsif ($ch eq KEY_DOWN or $ch eq "j") {
86			$menu_idx++;
87			} elsif ($ch eq KEY_UP or $ch eq "k") {
88			$menu_idx--;
89			} else {
90			eval {
91			$menu[$menu_idx][2]->($ch);
92			};
93			}
94			$refresh->start;
95			});
96
97			END {
98			end_win;
99			config "Mode: adhoc\n";
100			}
101
102			sub decode_tags {
103			my $pkt = shift;
104			my %tag;
105
106			while ($pkt) {
107			my ($id, $len) = unpack "C C", $pkt;
108			my $data = substr $pkt, 2, $len;
109			$pkt = substr $pkt, 2 + $len;
110
111			$id = ({
112			0 => SSID,
113			1 => rates,
114			2 => FH,
115			3 => DS,
116			4 => CF,
117			5 => TIM,
118			6 => IBSS,
119			16 => challenge,
120			})->{$id};
121			$tag{$id} = $data;
122			}
123
124			%tag;
125			}
126
127			sub PF_PACKET (){ 17 }
128			sub SOCK_RAW (){ 3 }
129			sub ETH_P_ALL (){ 0x0003 }
130			sub SIOCGIFINDEX (){ 0x000008933 }
131
132			sub open_pcap_socket {
133			socket my $cap, PF_PACKET, SOCK_RAW, (unpack "s", pack "n", ETH_P_ALL)
134			or die "unable to open packet socket: $!";
135
136			my $ifidx = pack "a16 I", $RAWDEV;
137			ioctl $cap, SIOCGIFINDEX, $ifidx
138			or die "can't get index of interface $RAWDEV: $!";
139			$ifidx = unpack "x16 I", $ifidx;
140
141			bind $cap, pack "S! S! I S! C C a8", PF_PACKET, (unpack "s", pack "n", ETH_P_ALL), $ifidx
142			or die "unable to bind to interface: $!";
143
144			$cap;
145			}
146
147			sub e2h($) {
148			join ":", map unpack("H*", $_), split //, $_[0];
149			}
150
151			sub add_menu {
152			my ($title, $display, $select) = @_;
153			push @menu, [$title, $display, $select];
154			}
155
156			$curmenu = \&menu_bss_list;
157
158			sub bss2string {
159			my $bss = shift;
160
161			my $s = "AGE(" . int(time - $bss->{ts}) . ") "
162			. "IP($bss->{ip}) "
163			. "ARP($bss->{arp}) ";
164			while (my ($k, $v) = each %{$bss->{ap}}) {
165			$s .= "(" . e2h($k) . " $v->{mode} '$v->{essid}') ";
166			}
167			$s;
168			}
169
170	root	1.5	sub show_map {
171			my ($map, $w, $h) = @_;
172
173	root	1.6	my $data = $GPS->data;
174
175			local $map->{"$data->{lat};$data->{long}"} = 0;
176
177	root	1.5	my @data = (("-" x $w) x $h);
178
179			my ($x1, $y1, $x2, $y2) = (1e6, 1e6, 1e-6, 1e-6);
180	root	1.6	my $level = 1;
181	root	1.5
182			while (my ($k, $v) = each %$map) {
183			my ($y, $x) = split /;/, $k;
184			$x1 = $x if $x1 > $x;
185			$x2 = $x if $x2 < $x;
186			$y1 = $y if $y1 > $y;
187			$y2 = $y if $y2 < $y;
188	root	1.6	$level = $v if $level < $v;
189	root	1.5	}
190
191			$x2 = ($w - 1) / (($x2 - $x1) \|\| 1e-6);
192			$y2 = ($h - 1) / (($y2 - $y1) \|\| 1e-6);
193
194			while (my ($k, $v) = each %$map) {
195			my ($y, $x) = split /;/, $k;
196
197			$y = ($y - $y1) * $y2;
198			$x = ($x - $x1) * $x2;
199
200	root	1.6	substr $data[$y], $x, 1, int($map->{$k} * 9 / $level);
201	root	1.5	}
202
203			for (@data) {
204			addstr $_ . "\n";
205			}
206			}
207
208	root	1.1	sub display_bss {
209			my $bss = shift;
210
211			addstr "TS: $bss->{ts}\n";
212	root	1.6	addstr "WEP/Weak packets received: $bss->{wep}/$bss->{weak}\n";
213			addstr "ARP/IP packets received: $bss->{arp}/$bss->{ip}\n";
214	root	1.1
215			addstr "\naccess points\n";
216
217			while (my ($k, $v) = each %{$bss->{ap}}) {
218			addstr " " . e2h($k) . "\n";
219	root	1.4	addstr " mode $v->{mode}; channel $v->{channel}; essid '$v->{essid}'; beacon frames $v->{beacon}\n";
220	root	1.1	}
221
222			addstr "\nstations\n";
223
224			while (my ($k, $v) = each %{$bss->{station}}) {
225			addstr " " . e2h($k);
226			while (my ($k, $v) = each %$v) {
227			addstr " " . (inet_ntoa $k) . "($v)";
228			}
229			addstr "\n";
230			}
231	root	1.5
232			if ($bss->{gps}) {
233	root	1.6	my ($x, $y); getyx $y, $x;
234	root	1.5	addstr "\nmap\n";
235	root	1.6	my $h = (&getmaxy - $y) - 3;
236			show_map $bss->{gps}, int($h*1.8), $h;
237	root	1.5	}
238	root	1.1	}
239
240			sub menu_bss_list {
241			my @menu;
242			while (my ($k, $v) = each %$db) {
243			add_menu e2h($k) . " " . bss2string($v),
244			sub { display_bss $v },
245			sub {
246			if ($_[0] eq KEY_LEFT or $_[0] eq "h") {
247			Event::unloop;
248			} elsif ($_[0] eq KEY_RIGHT or $_[0] eq "l") {
249			#$curmenu = sub { display_bss $k };
250			}
251	root	1.4	};
252	root	1.1	}
253			}
254
255			sub activity {
256	root	1.5	if ($GPS) {
257			my $data = $GPS->data;
258	root	1.6	$db->{$_[0]}{gps}{"$data->{lat};$data->{long}"} = signal_quality;
259	root	1.5	}
260	root	1.1	$db->{$_[0]}->{ts} = time;
261			$refresh->start;
262			}
263
264			sub reg_ip {
265			my ($bssid, $ip, $ether) = @_;
266			$db->{$bssid}{station}{$ether}{$ip}++;
267			activity $bssid;
268			}
269
270			{
271			my $cap = open_pcap_socket;
272			my $pkt;
273
274			Event->io(fd => $cap, poll => 'r', cb => sub {
275			sysread $$cap, $pkt, 120;
276
277			my ($fc1, $fc2, $sid, $a1, $a2, $a3, $sc, $pkt)
278			= unpack "C C n a6 a6 a6 S a*", $pkt;
279
280			$pkt = substr $pkt, 6 if $fc2 & 0x03 == 0x03; # skip A4
281
282			if ($fc1 == 0x80 or $fc1 == 0x50) {
283			my ($ts1, $ts2, $bi, $cf, $pkt)
284			= unpack "L L S S a*", $pkt;
285
286			my %tag = decode_tags $pkt;
287
288			my $ap = $db->{$a3}{ap}{$a2} \|\|= {};
289			$ap->{mode} = ($cf & 3) == 1 ? "AP" : "adhoc";
290			$ap->{essid} = $tag{SSID};
291			$ap->{channel} = ord $tag{DS};
292			$ap->{beacon}++;
293
294			activity $a3;
295			} elsif ($fc1 == 0x08) {
296			my $bssid = ($a3, $a2, $a1)[$fc2 & 3];
297
298	root	1.5	if ($fc2 & 0x40) {
299	root	1.6	my ($iv1, $iv2, $iv3, $ivopt, $byte) = unpack "C C C C C", $pkt;
300	root	1.5	$db->{$bssid}{wep}++;
301	root	1.6	if ($iv1 > 2 and $iv1 < 14 and $iv2 == 255) {
302			$db->{$bssid}{weak}++;
303			}
304	root	1.5	} else {
305			my ($llc, $et, $pkt) = unpack "a6 n a*", $pkt;
306			if ($llc eq "\xaa\xaa\x03\x00\x00\x00") { # SNAP/UI/ENCAP_ETHER
307			if ($et == 0x0800) {
308			my ($vhl, $tos, $len, $id, $off, $ttl, $prot, $sum, $src, $dst, $pkt)
309			= unpack "C C n n n C C n a4 a4 a*", $pkt;
310			if ($vhl & 0x40 == 0x40) {
311			$db->{$bssid}{ip}++;
312			reg_ip $bssid, $src, $a2;
313			reg_ip $bssid, $dst, $a1;
314			0 &&
315			printf "IP: %02x %02x %04x %04x: %s %s> %s %s %02x \n",
316			$fc1, $fc2, $sid, $sc,
317			(unpack "H*", $a2), (inet_ntoa $src),
318			(unpack "H*", $a1), (inet_ntoa $dst),
319			$prot;
320			}
321			} elsif ($et == 0x0806) {
322			my ($hrd, $pro, $hln, $pln, $op, $src_hw, $src, $dst_hw, $dst)
323			= unpack "n n C C n a6 a4 a6 a4", $pkt;
324			if ($hrd == 1 and $hln == 6 and $pln == 4) {
325			reg_ip $bssid, $src, $src_hw;
326			reg_ip $bssid, $dst, $dst_hw if $op != 1;
327			$db->{$bssid}{arp}++;
328			0 &&
329			printf "ARP: %04x> %s %s : %s %s\n",
330			$op,
331			(unpack "H*", $src_hw), (inet_ntoa $src),
332			(unpack "H*", $dst_hw), (inet_ntoa $dst);
333			}
334	root	1.1	}
335	root	1.5	} else {
336			0 &&
337			printf "?? %02x %02x %04x %04x: %s.%s \n", $fc1, $fc2, $sid, $sc, (unpack "H", $llc), unpack "H", $pkt;
338	root	1.1	}
339			}
340			} elsif ($fc1 != 0x40 and $fc1 != 0x10 and $fc1 != 0x00 and $fc1 != 0xb0) {
341			0 &&
342			printf "%02x %02x %04x %04x: %s \n", $fc1, $fc2, $sid, $sc, unpack "H*", $pkt;
343			}
344			});
345			}
346
347			Event::loop;
348
349