--- /dev/null
+// SoftEther UT-VPN SourceCode\r
+// \r
+// Copyright (C) 2004-2010 SoftEther Corporation.\r
+// Copyright (C) 2004-2010 University of Tsukuba, Japan.\r
+// Copyright (C) 2003-2010 Daiyuu Nobori.\r
+// All Rights Reserved.\r
+// \r
+// http://utvpn.tsukuba.ac.jp/\r
+// \r
+// This program is free software; you can redistribute it and/or\r
+// modify it under the terms of the GNU General Public License\r
+// version 2 as published by the Free Software Foundation.\r
+// \r
+// This program is distributed in the hope that it will be useful,\r
+// but WITHOUT ANY WARRANTY; without even the implied warranty of\r
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
+// GNU General Public License for more details.\r
+// \r
+// You should have received a copy of the GNU General Public License version 2\r
+// along with this program; if not, write to the Free Software\r
+// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.\r
+// \r
+// このファイルは GPL バージョン 2 ライセンスで公開されています。\r
+// 誰でもこのファイルの内容を複製、改変したり、改変したバージョンを再配布\r
+// することができます。ただし、原著作物を改変した場合は、原著作物の著作権表示\r
+// を除去することはできません。改変した著作物を配布する場合は、改変実施者の\r
+// 著作権表示を原著作物の著作権表示に付随して記載するようにしてください。\r
+// \r
+// この SoftEther UT-VPN オープンソース・プロジェクトは、日本国の\r
+// ソフトイーサ株式会社 (SoftEther Corporation, http://www.softether.co.jp/ )\r
+// および筑波大学 (University of Tsukuba, http://www.tsukuba.ac.jp/ ) によって\r
+// ホストされています。\r
+// 本プログラムの配布者は、本プログラムを、業としての利用以外のため、\r
+// および、試験または研究のために利用が行われることを想定して配布\r
+// しています。\r
+// SoftEther UT-VPN プロジェクトの Web サイトは http://utvpn.tsukuba.ac.jp/ に\r
+// あります。\r
+// 本ソフトウェアの不具合の修正、機能改良、セキュリティホールの修復などのコード\r
+// の改変を行った場合で、その成果物を SoftEther UT-VPN プロジェクトに提出して\r
+// いただける場合は、 http://utvpn.tsukuba.ac.jp/ までソースコードを送付して\r
+// ください。SoftEther UT-VPN プロジェクトの本体リリースまたはブランチリリース\r
+// に組み込みさせていただきます。\r
+// \r
+// GPL に基づいて原著作物が提供される本ソフトウェアの改良版を配布、販売する\r
+// 場合は、そのソースコードを GPL に基づいて誰にでも開示する義務が生じます。\r
+// \r
+// 本ソフトウェアに関連する著作権、特許権、商標権はソフトイーサ株式会社\r
+// (SoftEther Corporation) およびその他の著作権保持者が保有しています。\r
+// ソフトイーサ株式会社等はこれらの権利を放棄していません。本ソフトウェアの\r
+// 二次著作物を配布、販売する場合は、これらの権利を侵害しないようにご注意\r
+// ください。\r
+// \r
+// お願い: どのような通信ソフトウェアにも通常は必ず未発見の\r
+// セキュリティホールが潜んでいます。本ソースコードをご覧いただいた結果、\r
+// UT-VPN にセキュリティホールを発見された場合は、当該セキュリティホールの\r
+// 情報を不特定多数に開示される前に、必ず、ソフトイーサ株式会社\r
+// および脆弱性情報の届出を受け付ける公的機関まで通報いただき、\r
+// 公益保護にご協力いただきますようお願い申し上げます。\r
+// \r
+// ソフトイーサ株式会社は、当該セキュリティホールについて迅速に対処を\r
+// 行い、UT-VPN および UT-VPN に関連するソフトウェアのユーザー・顧客\r
+// を保護するための努力を行います。\r
+// \r
+// ソフトイーサへの届出先: http://www.softether.co.jp/jp/contact/\r
+// 日本国内の脆弱性情報届出受付公的機関:\r
+// 独立行政法人 情報処理推進機構\r
+// http://www.ipa.go.jp/security/vuln/report/\r
+// \r
+// 上記各事項について不明な点は、ソフトイーサ株式会社までご連絡ください。\r
+// 連絡先: http://www.softether.co.jp/jp/contact/\r
+\r
+// -----------------------------------------------\r
+// [ChangeLog]\r
+// 2010.05.20\r
+// 新規リリース by SoftEther\r
+// -----------------------------------------------\r
+\r
+// TcpIp.c\r
+// TCP/IP プロトコル パケットアナライザ\r
+\r
+#include "CedarPch.h"\r
+\r
+// パケットに VLAN タグを埋め込む\r
+void VLanInsertTag(void **packet_data, UINT *packet_size, UINT vlan_id)\r
+{\r
+ UINT dest_size;\r
+ UCHAR *dest_data;\r
+ UINT src_size;\r
+ UCHAR *src_data;\r
+ USHORT vlan_ushort = Endian16(((USHORT)vlan_id) & 0xFFF);\r
+ // 引数チェック\r
+ if (packet_data == NULL || *packet_data == NULL || packet_size == NULL ||\r
+ *packet_size < 14 || vlan_id == 0)\r
+ {\r
+ return;\r
+ }\r
+\r
+ src_size = *packet_size;\r
+ src_data = (UCHAR *)(*packet_data);\r
+\r
+ dest_size = src_size + 4;\r
+ dest_data = Malloc(dest_size);\r
+\r
+ dest_data[12] = 0x81;\r
+ dest_data[13] = 0x00;\r
+ Copy(&dest_data[14], &vlan_ushort, sizeof(USHORT));\r
+\r
+ Copy(&dest_data[0], &src_data[0], 12);\r
+ Copy(&dest_data[16], &src_data[12], src_size - 12);\r
+\r
+ *packet_size = dest_size;\r
+ *packet_data = dest_data;\r
+\r
+ Free(src_data);\r
+}\r
+\r
+// パケットから VLAN タグを取り除く\r
+bool VLanRemoveTag(void **packet_data, UINT *packet_size, UINT vlan_id)\r
+{\r
+ bool has_vlan_tag = false;\r
+ UCHAR *src_data;\r
+ UINT src_size;\r
+ // 引数チェック\r
+ if (packet_data == NULL || *packet_data == NULL || packet_size == NULL ||\r
+ *packet_size < 14)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ src_data = (UCHAR *)(*packet_data);\r
+ src_size = *packet_size;\r
+\r
+ if (src_data[12] == 0x81 && src_data[13] == 0x00)\r
+ {\r
+ if (src_size >= 18)\r
+ {\r
+ USHORT vlan_ushort;\r
+\r
+ vlan_ushort = Endian16(*((USHORT *)&src_data[14]));\r
+ vlan_ushort = vlan_ushort & 0xFFF;\r
+\r
+ if (vlan_id == 0 || (vlan_ushort == vlan_id))\r
+ {\r
+ UINT dest_size = src_size - 4;\r
+ UINT i;\r
+\r
+ for (i = 12;i < dest_size;i++)\r
+ {\r
+ src_data[i] = src_data[i + 4];\r
+ }\r
+\r
+ *packet_size = dest_size;\r
+\r
+ return true;\r
+ }\r
+ }\r
+ }\r
+\r
+ return false;\r
+}\r
+\r
+// ICMPv6 パケットの送信\r
+BUF *BuildICMPv6(IPV6_ADDR *src_ip, IPV6_ADDR *dest_ip, UCHAR hop_limit, UCHAR type, UCHAR code, void *data, UINT size, UINT id)\r
+{\r
+ ICMP_HEADER *icmp;\r
+ void *data_buf;\r
+ BUF *ret;\r
+ // 引数チェック\r
+ if (src_ip == NULL || dest_ip == NULL || data == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ // ヘッダの組み立て\r
+ icmp = ZeroMalloc(sizeof(ICMP_HEADER) + size);\r
+ data_buf = ((UCHAR *)icmp) + sizeof(ICMP_HEADER);\r
+ Copy(data_buf, data, size);\r
+\r
+ icmp->Type = type;\r
+ icmp->Code = code;\r
+ icmp->Checksum = CalcChecksumForIPv6(src_ip, dest_ip, IP_PROTO_ICMPV6, icmp,\r
+ sizeof(ICMP_HEADER) + size);\r
+\r
+ ret = BuildIPv6(dest_ip, src_ip, id, IP_PROTO_ICMPV6, hop_limit, icmp,\r
+ sizeof(ICMP_HEADER) + size);\r
+\r
+ Free(icmp);\r
+\r
+ return ret;\r
+}\r
+\r
+// ICMPv6 近隣要請パケットのビルド\r
+BUF *BuildICMPv6NeighborSoliciation(IPV6_ADDR *src_ip, IPV6_ADDR *target_ip, UCHAR *my_mac_address, UINT id)\r
+{\r
+ ICMPV6_OPTION_LIST opt;\r
+ ICMPV6_OPTION_LINK_LAYER link;\r
+ ICMPV6_NEIGHBOR_SOLICIATION_HEADER header;\r
+ BUF *b;\r
+ BUF *b2;\r
+ BUF *ret;\r
+ // 引数チェック\r
+ if (src_ip == NULL || target_ip == NULL || my_mac_address == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ Zero(&link, sizeof(link));\r
+ Copy(link.Address, my_mac_address, 6);\r
+\r
+ Zero(&opt, sizeof(opt));\r
+ opt.SourceLinkLayer = &link;\r
+\r
+ b = BuildICMPv6Options(&opt);\r
+\r
+ Zero(&header, sizeof(header));\r
+ Copy(&header.TargetAddress, target_ip, sizeof(IPV6_ADDR));\r
+\r
+ b2 = NewBuf();\r
+\r
+ WriteBuf(b2, &header, sizeof(header));\r
+ WriteBufBuf(b2, b);\r
+\r
+ ret = BuildICMPv6(src_ip, target_ip, 255,\r
+ ICMPV6_TYPE_NEIGHBOR_SOLICIATION, 0, b2->Buf, b2->Size, id);\r
+\r
+ FreeBuf(b);\r
+ FreeBuf(b2);\r
+\r
+ return ret;\r
+}\r
+\r
+// キューから次のヘッダ番号を取得\r
+UCHAR IPv6GetNextHeaderFromQueue(QUEUE *q)\r
+{\r
+ UINT *p;\r
+ UCHAR v;\r
+ // 引数チェック\r
+ if (q == NULL)\r
+ {\r
+ return IPV6_HEADER_NONE;\r
+ }\r
+\r
+ p = (UINT *)GetNext(q);\r
+ v = (UCHAR)(*p);\r
+ Free(p);\r
+\r
+ return v;\r
+}\r
+\r
+// IPv6 拡張オプションヘッダ (可変長) の追加\r
+void BuildAndAddIPv6PacketOptionHeader(BUF *b, IPV6_OPTION_HEADER *opt, UCHAR next_header, UINT size)\r
+{\r
+ IPV6_OPTION_HEADER *h;\r
+ UINT total_size;\r
+ // 引数チェック\r
+ if (b == NULL || opt == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ total_size = size;\r
+ if ((total_size % 8) != 0)\r
+ {\r
+ total_size = ((total_size / 8) + 1) * 8;\r
+ }\r
+\r
+ h = ZeroMalloc(total_size);\r
+ Copy(h, opt, size);\r
+ h->Size = (total_size / 8) - 1;\r
+ h->NextHeader = next_header;\r
+\r
+ WriteBuf(b, h, total_size);\r
+\r
+ Free(h);\r
+}\r
+\r
+// IPv6 パケットのビルド\r
+BUF *BuildIPv6(IPV6_ADDR *dest_ip, IPV6_ADDR *src_ip, UINT id, UCHAR protocol, UCHAR hop_limit, void *data,\r
+ UINT size)\r
+{\r
+ IPV6_HEADER_PACKET_INFO info;\r
+ IPV6_HEADER ip_header;\r
+ BUF *buf;\r
+ UINT size_for_headers;\r
+ // 引数チェック\r
+ if (dest_ip == NULL || src_ip == NULL || data == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+ if (hop_limit == 0)\r
+ {\r
+ hop_limit = 255;\r
+ }\r
+\r
+ // IPv6 ヘッダ\r
+ Zero(&ip_header, sizeof(ip_header));\r
+ IPV6_SET_VERSION(&ip_header, 6);\r
+ ip_header.HopLimit = hop_limit;\r
+ Copy(&ip_header.SrcAddress, src_ip, sizeof(IPV6_ADDR));\r
+ Copy(&ip_header.DestAddress, dest_ip, sizeof(IPV6_ADDR));\r
+\r
+ // ヘッダパケット情報の整理\r
+ Zero(&info, sizeof(info));\r
+ info.IPv6Header = &ip_header;\r
+ info.Protocol = protocol;\r
+ info.Payload = data;\r
+ info.PayloadSize = size;\r
+\r
+ buf = BuildIPv6PacketHeader(&info, &size_for_headers);\r
+ if (buf == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ return buf;\r
+}\r
+\r
+// IPv6 パケットヘッダ部のビルド\r
+BUF *BuildIPv6PacketHeader(IPV6_HEADER_PACKET_INFO *info, UINT *bytes_before_payload)\r
+{\r
+ BUF *b;\r
+ QUEUE *q;\r
+ UINT bbp = 0;\r
+ // 引数チェック\r
+ if (info == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ b = NewBuf();\r
+ q = NewQueueFast();\r
+\r
+ // オプションヘッダの一覧を作成\r
+ if (info->HopHeader != NULL)\r
+ {\r
+ InsertQueueInt(q, IPV6_HEADER_HOP);\r
+ }\r
+ if (info->EndPointHeader != NULL)\r
+ {\r
+ InsertQueueInt(q, IPV6_HEADER_ENDPOINT);\r
+ }\r
+ if (info->RoutingHeader != NULL)\r
+ {\r
+ InsertQueueInt(q, IPV6_HEADER_ROUTING);\r
+ }\r
+ if (info->FragmentHeader != NULL)\r
+ {\r
+ InsertQueueInt(q, IPV6_HEADER_FRAGMENT);\r
+ }\r
+ InsertQueueInt(q, info->Protocol);\r
+\r
+ // IPv6 ヘッダ\r
+ info->IPv6Header->NextHeader = IPv6GetNextHeaderFromQueue(q);\r
+ WriteBuf(b, info->IPv6Header, sizeof(IPV6_HEADER));\r
+\r
+ // ホップバイホップオプションヘッダ\r
+ if (info->HopHeader != NULL)\r
+ {\r
+ BuildAndAddIPv6PacketOptionHeader(b, info->HopHeader,\r
+ IPv6GetNextHeaderFromQueue(q), info->HopHeaderSize);\r
+ }\r
+\r
+ // 終点オプションヘッダ\r
+ if (info->EndPointHeader != NULL)\r
+ {\r
+ BuildAndAddIPv6PacketOptionHeader(b, info->EndPointHeader,\r
+ IPv6GetNextHeaderFromQueue(q), info->EndPointHeaderSize);\r
+ }\r
+\r
+ // ルーティングヘッダ\r
+ if (info->RoutingHeader != NULL)\r
+ {\r
+ BuildAndAddIPv6PacketOptionHeader(b, info->RoutingHeader,\r
+ IPv6GetNextHeaderFromQueue(q), info->RoutingHeaderSize);\r
+ }\r
+\r
+ // フラグメントヘッダ\r
+ if (info->FragmentHeader != NULL)\r
+ {\r
+ info->FragmentHeader->NextHeader = IPv6GetNextHeaderFromQueue(q);\r
+ WriteBuf(b, info->FragmentHeader, sizeof(IPV6_FRAGMENT_HEADER));\r
+ }\r
+\r
+ bbp = b->Size;\r
+ if (info->FragmentHeader == NULL)\r
+ {\r
+ bbp += sizeof(IPV6_FRAGMENT_HEADER);\r
+ }\r
+\r
+ // ペイロード\r
+ if (info->Protocol != IPV6_HEADER_NONE)\r
+ {\r
+ WriteBuf(b, info->Payload, info->PayloadSize);\r
+ }\r
+\r
+ ReleaseQueue(q);\r
+\r
+ SeekBuf(b, 0, 0);\r
+\r
+ // ペイロード長さ\r
+ ((IPV6_HEADER *)b->Buf)->PayloadLength = Endian16(b->Size - (USHORT)sizeof(IPV6_HEADER));\r
+\r
+ if (bytes_before_payload != NULL)\r
+ {\r
+ // ペイロードの直前までの長さ (ただしフラグメントヘッダは必ず含まれると仮定)\r
+ // を計算する\r
+ *bytes_before_payload = bbp;\r
+ }\r
+\r
+ return b;\r
+}\r
+\r
+// ICMPv6 パケットのオプション値のビルド\r
+void BuildICMPv6OptionValue(BUF *b, UCHAR type, void *header_pointer, UINT total_size)\r
+{\r
+ UINT packet_size;\r
+ UCHAR *packet;\r
+ ICMPV6_OPTION *opt;\r
+ // 引数チェック\r
+ if (b == NULL || header_pointer == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ packet_size = ((total_size + 7) / 8) * 8;\r
+ packet = ZeroMalloc(packet_size);\r
+\r
+ Copy(packet, header_pointer, total_size);\r
+ opt = (ICMPV6_OPTION *)packet;\r
+ opt->Length = (UCHAR)(packet_size / 8);\r
+ opt->Type = type;\r
+\r
+ WriteBuf(b, packet, packet_size);\r
+\r
+ Free(packet);\r
+}\r
+\r
+// ICMPv6 パケットのオプションのビルド\r
+BUF *BuildICMPv6Options(ICMPV6_OPTION_LIST *o)\r
+{\r
+ BUF *b;\r
+ // 引数チェック\r
+ if (o == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ b = NewBuf();\r
+\r
+ if (o->SourceLinkLayer != NULL)\r
+ {\r
+ BuildICMPv6OptionValue(b, ICMPV6_OPTION_TYPE_SOURCE_LINK_LAYER, o->SourceLinkLayer, sizeof(ICMPV6_OPTION_LINK_LAYER));\r
+ }\r
+ if (o->TargetLinkLayer != NULL)\r
+ {\r
+ BuildICMPv6OptionValue(b, ICMPV6_OPTION_TYPE_TARGET_LINK_LAYER, o->TargetLinkLayer, sizeof(ICMPV6_OPTION_LINK_LAYER));\r
+ }\r
+ if (o->Prefix != NULL)\r
+ {\r
+ BuildICMPv6OptionValue(b, ICMPV6_OPTION_TYPE_PREFIX, o->Prefix, sizeof(ICMPV6_OPTION_PREFIX));\r
+ }\r
+ if (o->Mtu != NULL)\r
+ {\r
+ BuildICMPv6OptionValue(b, ICMPV6_OPTION_TYPE_MTU, o->Mtu, sizeof(ICMPV6_OPTION_MTU));\r
+ }\r
+\r
+ SeekBuf(b, 0, 0);\r
+\r
+ return b;\r
+}\r
+\r
+// チェックサム計算\r
+USHORT CalcChecksumForIPv6(IPV6_ADDR *src_ip, IPV6_ADDR *dest_ip, UCHAR protocol, void *data, UINT size)\r
+{\r
+ UCHAR *tmp;\r
+ UINT tmp_size;\r
+ IPV6_PSEUDO_HEADER *ph;\r
+ USHORT ret;\r
+ // 引数チェック\r
+ if (data == NULL && size != 0)\r
+ {\r
+ return 0;\r
+ }\r
+\r
+ tmp_size = size + sizeof(IPV6_PSEUDO_HEADER);\r
+ tmp = ZeroMalloc(tmp_size);\r
+\r
+ ph = (IPV6_PSEUDO_HEADER *)tmp;\r
+ Copy(&ph->SrcAddress, src_ip, sizeof(IPV6_ADDR));\r
+ Copy(&ph->DestAddress, dest_ip, sizeof(IPV6_ADDR));\r
+ ph->UpperLayerPacketSize = Endian32(size);\r
+ ph->NextHeader = protocol;\r
+\r
+ Copy(((UCHAR *)tmp) + sizeof(IPV6_PSEUDO_HEADER), data, size);\r
+\r
+ ret = IpChecksum(tmp, tmp_size);\r
+\r
+ Free(tmp);\r
+\r
+ return ret;\r
+}\r
+\r
+// クローンされたパケットを解放する\r
+void FreeClonePacket(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ Free(p->IPv6HeaderPacketInfo.IPv6Header);\r
+ Free(p->IPv6HeaderPacketInfo.HopHeader);\r
+ Free(p->IPv6HeaderPacketInfo.EndPointHeader);\r
+ Free(p->IPv6HeaderPacketInfo.RoutingHeader);\r
+ Free(p->IPv6HeaderPacketInfo.FragmentHeader);\r
+ Free(p->IPv6HeaderPacketInfo.Payload);\r
+ Free(p->ICMPv6HeaderPacketInfo.Data);\r
+ Free(p->ICMPv6HeaderPacketInfo.EchoData);\r
+ Free(p->ICMPv6HeaderPacketInfo.Headers.HeaderPointer);\r
+ FreeCloneICMPv6Options(&p->ICMPv6HeaderPacketInfo.OptionList);\r
+ Free(p->L3.PointerL3);\r
+ Free(p->L4.PointerL4);\r
+ Free(p->L7.PointerL7);\r
+ Free(p->PacketData);\r
+ Free(p->MacHeader);\r
+ Free(p);\r
+}\r
+\r
+// パケットヘッダをコピーする\r
+PKT *ClonePacket(PKT *p, bool copy_data)\r
+{\r
+ PKT *ret;\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ ret = ZeroMallocFast(sizeof(PKT));\r
+ ret->PacketSize = p->PacketSize;\r
+\r
+ // MAC ヘッダのコピー\r
+ ret->MacHeader = MallocFast(sizeof(MAC_HEADER));\r
+ Copy(ret->MacHeader, p->MacHeader, sizeof(MAC_HEADER));\r
+\r
+ // MAC フラグのコピー\r
+ ret->BroadcastPacket = p->BroadcastPacket;\r
+ ret->InvalidSourcePacket = p->InvalidSourcePacket;\r
+\r
+ // IPv6 関係構造体のコピー\r
+ Copy(&ret->IPv6HeaderPacketInfo, &p->IPv6HeaderPacketInfo, sizeof(IPV6_HEADER_PACKET_INFO));\r
+ Copy(&ret->ICMPv6HeaderPacketInfo, &p->ICMPv6HeaderPacketInfo, sizeof(ICMPV6_HEADER_INFO));\r
+\r
+ // Layer 3\r
+ ret->TypeL3 = p->TypeL3;\r
+ switch (ret->TypeL3)\r
+ {\r
+ case L3_ARPV4:\r
+ // ARP パケット\r
+ ret->L3.ARPv4Header = MallocFast(sizeof(ARPV4_HEADER));\r
+ Copy(ret->L3.ARPv4Header, p->L3.ARPv4Header, sizeof(ARPV4_HEADER));\r
+ break;\r
+\r
+ case L3_IPV4:\r
+ // IPv4 パケット\r
+ ret->L3.IPv4Header = MallocFast(sizeof(IPV4_HEADER));\r
+ Copy(ret->L3.IPv4Header, p->L3.IPv4Header, sizeof(IPV4_HEADER));\r
+ break;\r
+\r
+ case L3_IPV6:\r
+ // IPv6 パケット\r
+ ret->L3.IPv6Header = MallocFast(sizeof(IPV6_HEADER));\r
+ Copy(ret->L3.IPv6Header, p->L3.IPv6Header, sizeof(IPV6_HEADER));\r
+\r
+ ret->IPv6HeaderPacketInfo.IPv6Header = Clone(p->IPv6HeaderPacketInfo.IPv6Header,\r
+ sizeof(IPV6_HEADER));\r
+\r
+ ret->IPv6HeaderPacketInfo.HopHeader = Clone(p->IPv6HeaderPacketInfo.HopHeader,\r
+ sizeof(IPV6_OPTION_HEADER));\r
+\r
+ ret->IPv6HeaderPacketInfo.EndPointHeader = Clone(p->IPv6HeaderPacketInfo.EndPointHeader,\r
+ sizeof(IPV6_OPTION_HEADER));\r
+\r
+ ret->IPv6HeaderPacketInfo.RoutingHeader = Clone(p->IPv6HeaderPacketInfo.RoutingHeader,\r
+ sizeof(IPV6_OPTION_HEADER));\r
+\r
+ ret->IPv6HeaderPacketInfo.FragmentHeader = Clone(p->IPv6HeaderPacketInfo.FragmentHeader,\r
+ sizeof(IPV6_FRAGMENT_HEADER));\r
+\r
+ ret->IPv6HeaderPacketInfo.Payload = Clone(p->IPv6HeaderPacketInfo.Payload,\r
+ p->IPv6HeaderPacketInfo.PayloadSize);\r
+ break;\r
+ }\r
+\r
+ // Layer 4\r
+ ret->TypeL4 = p->TypeL4;\r
+ switch (ret->TypeL4)\r
+ {\r
+ case L4_ICMPV4:\r
+ // ICMPv4 パケット\r
+ ret->L4.ICMPHeader = MallocFast(sizeof(ICMP_HEADER));\r
+ Copy(ret->L4.ICMPHeader, p->L4.ICMPHeader, sizeof(ICMP_HEADER));\r
+ break;\r
+\r
+ case L4_ICMPV6:\r
+ // ICMPv6 パケット\r
+ ret->L4.ICMPHeader = MallocFast(sizeof(ICMP_HEADER));\r
+ Copy(ret->L4.ICMPHeader, p->L4.ICMPHeader, sizeof(ICMP_HEADER));\r
+\r
+ ret->ICMPv6HeaderPacketInfo.Data = Clone(p->ICMPv6HeaderPacketInfo.Data,\r
+ p->ICMPv6HeaderPacketInfo.DataSize);\r
+\r
+ ret->ICMPv6HeaderPacketInfo.EchoData = Clone(p->ICMPv6HeaderPacketInfo.EchoData,\r
+ p->ICMPv6HeaderPacketInfo.EchoDataSize);\r
+\r
+ switch (ret->ICMPv6HeaderPacketInfo.Type)\r
+ {\r
+ case ICMPV6_TYPE_ECHO_REQUEST:\r
+ case ICMPV6_TYPE_ECHO_RESPONSE:\r
+ break;\r
+\r
+ case ICMPV6_TYPE_ROUTER_SOLICIATION:\r
+ ret->ICMPv6HeaderPacketInfo.Headers.RouterSoliciationHeader =\r
+ Clone(p->ICMPv6HeaderPacketInfo.Headers.RouterSoliciationHeader,\r
+ sizeof(ICMPV6_ROUTER_SOLICIATION_HEADER));\r
+ break;\r
+\r
+ case ICMPV6_TYPE_ROUTER_ADVERTISEMENT:\r
+ ret->ICMPv6HeaderPacketInfo.Headers.RouterAdvertisementHeader =\r
+ Clone(p->ICMPv6HeaderPacketInfo.Headers.RouterAdvertisementHeader,\r
+ sizeof(ICMPV6_ROUTER_ADVERTISEMENT_HEADER));\r
+ break;\r
+\r
+ case ICMPV6_TYPE_NEIGHBOR_SOLICIATION:\r
+ ret->ICMPv6HeaderPacketInfo.Headers.NeighborSoliciationHeader =\r
+ Clone(p->ICMPv6HeaderPacketInfo.Headers.NeighborSoliciationHeader,\r
+ sizeof(ICMPV6_NEIGHBOR_SOLICIATION_HEADER));\r
+ break;\r
+\r
+ case ICMPV6_TYPE_NEIGHBOR_ADVERTISEMENT:\r
+ ret->ICMPv6HeaderPacketInfo.Headers.NeighborAdvertisementHeader =\r
+ Clone(p->ICMPv6HeaderPacketInfo.Headers.NeighborAdvertisementHeader,\r
+ sizeof(ICMPV6_NEIGHBOR_ADVERTISEMENT_HEADER));\r
+ break;\r
+ }\r
+\r
+ CloneICMPv6Options(&ret->ICMPv6HeaderPacketInfo.OptionList,\r
+ &p->ICMPv6HeaderPacketInfo.OptionList);\r
+ break;\r
+\r
+ case L4_TCP:\r
+ // TCP パケット\r
+ ret->L4.TCPHeader = MallocFast(sizeof(TCP_HEADER));\r
+ Copy(ret->L4.TCPHeader, p->L4.TCPHeader, sizeof(TCP_HEADER));\r
+ break;\r
+\r
+ case L4_UDP:\r
+ // UDP パケット\r
+ ret->L4.UDPHeader = MallocFast(sizeof(UDP_HEADER));\r
+ Copy(ret->L4.UDPHeader, p->L4.UDPHeader, sizeof(UDP_HEADER));\r
+ break;\r
+ }\r
+\r
+ // Layer 7\r
+ ret->TypeL7 = p->TypeL7;\r
+ switch (ret->TypeL7)\r
+ {\r
+ case L7_DHCPV4:\r
+ // DHCP パケット\r
+ ret->L7.DHCPv4Header = MallocFast(sizeof(DHCPV4_HEADER));\r
+ Copy(ret->L7.DHCPv4Header, p->L7.DHCPv4Header, sizeof(DHCPV4_HEADER));\r
+ break;\r
+ }\r
+\r
+ // アドレスデータ\r
+ ret->MacAddressSrc = ret->MacHeader->SrcAddress;\r
+ ret->MacAddressDest = ret->MacHeader->DestAddress;\r
+\r
+ if (copy_data)\r
+ {\r
+ // パケット本体もコピー\r
+ ret->PacketData = MallocFast(p->PacketSize);\r
+ Copy(ret->PacketData, p->PacketData, p->PacketSize);\r
+ }\r
+\r
+ return ret;\r
+}\r
+\r
+// パケットの中身をパースする\r
+PKT *ParsePacket(UCHAR *buf, UINT size)\r
+{\r
+ return ParsePacketEx(buf, size, false);\r
+}\r
+PKT *ParsePacketEx(UCHAR *buf, UINT size, bool no_l3)\r
+{\r
+ return ParsePacketEx2(buf, size, no_l3, 0);\r
+}\r
+PKT *ParsePacketEx2(UCHAR *buf, UINT size, bool no_l3, UINT vlan_type_id)\r
+{\r
+ return ParsePacketEx3(buf, size, no_l3, vlan_type_id, true);\r
+}\r
+PKT *ParsePacketEx3(UCHAR *buf, UINT size, bool no_l3, UINT vlan_type_id, bool bridge_id_as_mac_address)\r
+{\r
+ PKT *p;\r
+ // 引数チェック\r
+ if (buf == NULL || size == 0)\r
+ {\r
+ return NULL;\r
+ }\r
+\r
+ if (vlan_type_id == 0)\r
+ {\r
+ vlan_type_id = MAC_PROTO_TAGVLAN;\r
+ }\r
+\r
+ p = ZeroMallocFast(sizeof(PKT));\r
+\r
+ p->VlanTypeID = vlan_type_id;\r
+\r
+ // パース実行\r
+ if (ParsePacketL2Ex(p, buf, size, no_l3) == false)\r
+ {\r
+ // パース失敗\r
+ FreePacket(p);\r
+ return NULL;\r
+ }\r
+\r
+ p->PacketData = buf;\r
+ p->PacketSize = size;\r
+\r
+ p->MacAddressSrc = p->MacHeader->SrcAddress;\r
+ p->MacAddressDest = p->MacHeader->DestAddress;\r
+\r
+ if (bridge_id_as_mac_address)\r
+ {\r
+ if (p->TypeL3 == L3_BPDU)\r
+ {\r
+ if (p->L3.BpduHeader != NULL)\r
+ {\r
+ p->MacAddressSrc = p->L3.BpduHeader->BridgeMacAddress;\r
+ }\r
+ }\r
+ }\r
+\r
+ // パース成功\r
+ return p;\r
+}\r
+\r
+\r
+// Layer-2 パース\r
+bool ParsePacketL2(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ return ParsePacketL2Ex(p, buf, size, false);\r
+}\r
+bool ParsePacketL2Ex(PKT *p, UCHAR *buf, UINT size, bool no_l3)\r
+{\r
+ UINT i;\r
+ bool b1, b2;\r
+ USHORT type_id_16;\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(MAC_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // MAC ヘッダ\r
+ p->MacHeader = (MAC_HEADER *)buf;\r
+\r
+ buf += sizeof(MAC_HEADER);\r
+ size -= sizeof(MAC_HEADER);\r
+\r
+ // MAC ヘッダの解析\r
+ p->BroadcastPacket = true;\r
+ b1 = true;\r
+ b2 = true;\r
+ for (i = 0;i < 6;i++)\r
+ {\r
+ if (p->MacHeader->DestAddress[i] != 0xff)\r
+ {\r
+ p->BroadcastPacket = false;\r
+ }\r
+ if (p->MacHeader->SrcAddress[i] != 0xff)\r
+ {\r
+ b1 = false;\r
+ }\r
+ if (p->MacHeader->SrcAddress[i] != 0x00)\r
+ {\r
+ b2 = false;\r
+ }\r
+ }\r
+ if (b1 || b2 || (Cmp(p->MacHeader->SrcAddress, p->MacHeader->DestAddress, 6) == 0))\r
+ {\r
+ p->InvalidSourcePacket = true;\r
+ }\r
+ else\r
+ {\r
+ p->InvalidSourcePacket = false;\r
+ }\r
+\r
+ if (p->MacHeader->DestAddress[0] & 0x01)\r
+ {\r
+ p->BroadcastPacket = true;\r
+ }\r
+\r
+ // L3 パケットのパース\r
+ type_id_16 = Endian16(p->MacHeader->Protocol);\r
+\r
+ if (type_id_16 > 1500)\r
+ {\r
+ // 通常の Ethernet フレーム\r
+ switch (type_id_16)\r
+ {\r
+ case MAC_PROTO_ARPV4: // ARPv4\r
+ if (no_l3)\r
+ {\r
+ return true;\r
+ }\r
+\r
+ return ParsePacketARPv4(p, buf, size);\r
+\r
+ case MAC_PROTO_IPV4: // IPv4\r
+ if (no_l3)\r
+ {\r
+ return true;\r
+ }\r
+\r
+ return ParsePacketIPv4(p, buf, size);\r
+\r
+ case MAC_PROTO_IPV6: // IPv6\r
+ if (no_l3)\r
+ {\r
+ return true;\r
+ }\r
+\r
+ return ParsePacketIPv6(p, buf, size);\r
+\r
+ default: // 不明\r
+ if (type_id_16 == p->VlanTypeID)\r
+ {\r
+ // VLAN\r
+ return ParsePacketTAGVLAN(p, buf, size);\r
+ }\r
+ else\r
+ {\r
+ return true;\r
+ }\r
+ }\r
+ }\r
+ else\r
+ {\r
+ // IEEE 802.3 の古い (パケットのペイロード長が書いてある) フレーム\r
+ // (BPDU 等で使われていることがある)\r
+ UINT length = (UINT)type_id_16;\r
+ LLC_HEADER *llc;\r
+\r
+ // 長さが残っているかどうかチェック\r
+ if (size < length || size < sizeof(LLC_HEADER))\r
+ {\r
+ return true;\r
+ }\r
+\r
+ // LLC ヘッダを読む\r
+ llc = (LLC_HEADER *)buf;\r
+ buf += sizeof(LLC_HEADER);\r
+ size -= sizeof(LLC_HEADER);\r
+\r
+ // DSAP, SSAP の値によってプロトコルを判定する\r
+ if (llc->Dsap == LLC_DSAP_BPDU && llc->Ssap == LLC_SSAP_BPDU)\r
+ {\r
+ // BPDU (Spanning Tree) である\r
+ return ParsePacketBPDU(p, buf, size);\r
+ }\r
+ else\r
+ {\r
+ // 不明なプロトコルである\r
+ return true;\r
+ }\r
+ }\r
+}\r
+\r
+// TAG VLAN パース\r
+bool ParsePacketTAGVLAN(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ USHORT vlan_ushort;\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(TAGVLAN_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // TAG VLAN ヘッダ\r
+ p->L3.TagVlanHeader = (TAGVLAN_HEADER *)buf;\r
+ p->TypeL3 = L3_TAGVLAN;\r
+\r
+ buf += sizeof(TAGVLAN_HEADER);\r
+ size -= sizeof(TAGVLAN_HEADER);\r
+\r
+ vlan_ushort = Endian16(*((USHORT *)p->L3.TagVlanHeader->Data));\r
+ vlan_ushort = vlan_ushort & 0xFFF;\r
+\r
+ p->VlanId = vlan_ushort;\r
+\r
+ return true;\r
+}\r
+\r
+// BPDU パース\r
+bool ParsePacketBPDU(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(BPDU_HEADER))\r
+ {\r
+ return true;\r
+ }\r
+\r
+ // BPDU ヘッダ\r
+ p->L3.BpduHeader = (BPDU_HEADER *)buf;\r
+ p->TypeL3 = L3_BPDU;\r
+\r
+ buf += sizeof(BPDU_HEADER);\r
+ size -= sizeof(BPDU_HEADER);\r
+\r
+ return true;\r
+}\r
+\r
+// ARPv4 パース\r
+bool ParsePacketARPv4(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(ARPV4_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // ARPv4 ヘッダ\r
+ p->L3.ARPv4Header = (ARPV4_HEADER *)buf;\r
+ p->TypeL3 = L3_ARPV4;\r
+\r
+ buf += sizeof(ARPV4_HEADER);\r
+ size -= sizeof(ARPV4_HEADER);\r
+\r
+ return true;\r
+}\r
+\r
+// IPv6 拡張ヘッダの解析\r
+bool ParseIPv6ExtHeader(IPV6_HEADER_PACKET_INFO *info, UCHAR next_header, UCHAR *buf, UINT size)\r
+{\r
+ bool ret = false;\r
+ IPV6_OPTION_HEADER *option_header;\r
+ UINT option_header_size;\r
+ UCHAR next_header_2 = IPV6_HEADER_NONE;\r
+ // 引数チェック\r
+ if (info == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ info->IsFragment = false;\r
+\r
+ while (true)\r
+ {\r
+ if (size > 8)\r
+ {\r
+ next_header_2 = *((UCHAR *)buf);\r
+ }\r
+\r
+ switch (next_header)\r
+ {\r
+ case IPV6_HEADER_HOP:\r
+ case IPV6_HEADER_ENDPOINT:\r
+ case IPV6_HEADER_ROUTING:\r
+ // 可変長ヘッダ\r
+ if (size < 8)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ option_header = (IPV6_OPTION_HEADER *)buf;\r
+ option_header_size = (option_header->Size + 1) * 8;\r
+ if (size < option_header_size)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ switch (next_header)\r
+ {\r
+ case IPV6_HEADER_HOP:\r
+ info->HopHeader = (IPV6_OPTION_HEADER *)buf;\r
+ info->HopHeaderSize = option_header_size;\r
+ break;\r
+\r
+ case IPV6_HEADER_ENDPOINT:\r
+ info->EndPointHeader = (IPV6_OPTION_HEADER *)buf;\r
+ info->EndPointHeaderSize = option_header_size;\r
+ break;\r
+\r
+ case IPV6_HEADER_ROUTING:\r
+ info->RoutingHeader = (IPV6_OPTION_HEADER *)buf;\r
+ info->RoutingHeaderSize = option_header_size;\r
+ break;\r
+ }\r
+\r
+ buf += option_header_size;\r
+ size -= option_header_size;\r
+ break;\r
+\r
+ case IPV6_HEADER_FRAGMENT:\r
+ // フラグメントヘッダ (固定長)\r
+ if (size < sizeof(IPV6_FRAGMENT_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ info->FragmentHeader = (IPV6_FRAGMENT_HEADER *)buf;\r
+\r
+ if (IPV6_GET_FRAGMENT_OFFSET(info->FragmentHeader) != 0)\r
+ {\r
+ info->IsFragment = true;\r
+ }\r
+\r
+ buf += sizeof(IPV6_FRAGMENT_HEADER);\r
+ size -= sizeof(IPV6_FRAGMENT_HEADER);\r
+ break;\r
+\r
+ default:\r
+ // 後にペイロードが続くとみなす\r
+ if (next_header != IPV6_HEADER_NONE)\r
+ {\r
+ info->Payload = buf;\r
+ info->PayloadSize = size;\r
+ }\r
+ else\r
+ {\r
+ info->Payload = NULL;\r
+ info->PayloadSize = 0;\r
+ }\r
+ info->Protocol = next_header;\r
+ return true;\r
+ }\r
+\r
+ next_header = next_header_2;\r
+ }\r
+}\r
+\r
+// IPv6 ヘッダの解析\r
+bool ParsePacketIPv6Header(IPV6_HEADER_PACKET_INFO *info, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (info == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ Zero(info, sizeof(IPV6_HEADER_PACKET_INFO));\r
+\r
+ // IPv6 ヘッダ\r
+ if (size < sizeof(IPV6_HEADER))\r
+ {\r
+ // サイズ不正\r
+ return false;\r
+ }\r
+\r
+ info->IPv6Header = (IPV6_HEADER *)buf;\r
+ buf += sizeof(IPV6_HEADER);\r
+ size -= sizeof(IPV6_HEADER);\r
+\r
+ if (IPV6_GET_VERSION(info->IPv6Header) != 6)\r
+ {\r
+ // バージョン不正\r
+ return false;\r
+ }\r
+\r
+ // 拡張ヘッダの解析\r
+ return ParseIPv6ExtHeader(info, info->IPv6Header->NextHeader, buf, size);\r
+}\r
+\r
+// ICMPv6 パケットのオプションの解析\r
+bool ParseICMPv6Options(ICMPV6_OPTION_LIST *o, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (o == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ Zero(o, sizeof(ICMPV6_OPTION_LIST));\r
+\r
+ // ヘッダ部分の読み込み\r
+ while (true)\r
+ {\r
+ ICMPV6_OPTION *option_header;\r
+ UINT header_total_size;\r
+ UCHAR *header_pointer;\r
+ if (size < sizeof(ICMPV6_OPTION))\r
+ {\r
+ // サイズ不足\r
+ return true;\r
+ }\r
+\r
+ option_header = (ICMPV6_OPTION *)buf;\r
+ // ヘッダ全体サイズの計算\r
+ header_total_size = option_header->Length * 8;\r
+ if (header_total_size == 0)\r
+ {\r
+ // サイズがゼロ\r
+ return true;\r
+ }\r
+ if (size < header_total_size)\r
+ {\r
+ // サイズ不足\r
+ return true;\r
+ }\r
+\r
+ header_pointer = buf;\r
+ buf += header_total_size;\r
+ size -= header_total_size;\r
+\r
+ switch (option_header->Type)\r
+ {\r
+ case ICMPV6_OPTION_TYPE_SOURCE_LINK_LAYER:\r
+ case ICMPV6_OPTION_TYPE_TARGET_LINK_LAYER:\r
+ // ソース or ターゲットリンクレイヤオプション\r
+ if (header_total_size >= sizeof(ICMPV6_OPTION_LINK_LAYER))\r
+ {\r
+ if (option_header->Type == ICMPV6_OPTION_TYPE_SOURCE_LINK_LAYER)\r
+ {\r
+ o->SourceLinkLayer = (ICMPV6_OPTION_LINK_LAYER *)header_pointer;\r
+ }\r
+ else\r
+ {\r
+ o->TargetLinkLayer = (ICMPV6_OPTION_LINK_LAYER *)header_pointer;\r
+ }\r
+ }\r
+ else\r
+ {\r
+ // ICMPv6 パケット破損?\r
+ return false;\r
+ }\r
+ break;\r
+\r
+ case ICMPV6_OPTION_TYPE_PREFIX:\r
+ // プレフィックス情報\r
+ if (header_total_size >= sizeof(ICMPV6_OPTION_PREFIX))\r
+ {\r
+ o->Prefix = (ICMPV6_OPTION_PREFIX *)header_pointer;\r
+ }\r
+ else\r
+ {\r
+ // ICMPv6 パケット破損?\r
+ }\r
+ break;\r
+\r
+ case ICMPV6_OPTION_TYPE_MTU:\r
+ // MTU\r
+ if (header_total_size >= sizeof(ICMPV6_OPTION_MTU))\r
+ {\r
+ o->Mtu = (ICMPV6_OPTION_MTU *)header_pointer;\r
+ }\r
+ else\r
+ {\r
+ // ICMPv6 パケット破損?\r
+ }\r
+ break;\r
+ }\r
+ }\r
+}\r
+\r
+// ICMPv6 パース\r
+bool ParseICMPv6(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ ICMPV6_HEADER_INFO icmp_info;\r
+ ICMP_HEADER *icmp;\r
+ ICMP_ECHO *echo;\r
+ UINT msg_size;\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ Zero(&icmp_info, sizeof(icmp_info));\r
+\r
+ if (size < sizeof(ICMP_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ icmp = (ICMP_HEADER *)buf;\r
+ p->L4.ICMPHeader = icmp;\r
+\r
+ msg_size = size - sizeof(ICMP_HEADER);\r
+\r
+ icmp_info.Type = icmp->Type;\r
+ icmp_info.Code = icmp->Code;\r
+ icmp_info.Data = ((UCHAR *)buf) + sizeof(ICMP_HEADER);\r
+ icmp_info.DataSize = msg_size;\r
+\r
+ switch (icmp_info.Type)\r
+ {\r
+ case ICMPV6_TYPE_ECHO_REQUEST:\r
+ case ICMPV6_TYPE_ECHO_RESPONSE:\r
+ // ICMP Echo Request / Response\r
+ if (icmp_info.DataSize < sizeof(ICMP_ECHO))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ echo = (ICMP_ECHO *)icmp_info.Data;\r
+\r
+ icmp_info.EchoHeader.Identifier = Endian16(echo->Identifier);\r
+ icmp_info.EchoHeader.SeqNo = Endian16(echo->SeqNo);\r
+ icmp_info.EchoData = (UCHAR *)echo + sizeof(ICMP_ECHO);\r
+ icmp_info.EchoDataSize = icmp_info.DataSize - sizeof(ICMP_ECHO);\r
+\r
+ break;\r
+\r
+ case ICMPV6_TYPE_ROUTER_SOLICIATION:\r
+ // ルータ要請\r
+ if (icmp_info.DataSize < sizeof(ICMPV6_ROUTER_SOLICIATION_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ icmp_info.Headers.RouterSoliciationHeader =\r
+ (ICMPV6_ROUTER_SOLICIATION_HEADER *)(((UCHAR *)icmp_info.Data));\r
+\r
+ if (ParseICMPv6Options(&icmp_info.OptionList, ((UCHAR *)icmp_info.Headers.HeaderPointer) + sizeof(ICMPV6_ROUTER_SOLICIATION_HEADER),\r
+ icmp_info.DataSize - sizeof(ICMPV6_ROUTER_SOLICIATION_HEADER)) == false)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ break;\r
+\r
+ case ICMPV6_TYPE_ROUTER_ADVERTISEMENT:\r
+ // ルータ広告\r
+ if (icmp_info.DataSize < sizeof(ICMPV6_ROUTER_ADVERTISEMENT_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ icmp_info.Headers.RouterAdvertisementHeader =\r
+ (ICMPV6_ROUTER_ADVERTISEMENT_HEADER *)(((UCHAR *)icmp_info.Data));\r
+\r
+ if (ParseICMPv6Options(&icmp_info.OptionList, ((UCHAR *)icmp_info.Headers.HeaderPointer) + sizeof(ICMPV6_ROUTER_ADVERTISEMENT_HEADER),\r
+ icmp_info.DataSize - sizeof(ICMPV6_ROUTER_ADVERTISEMENT_HEADER)) == false)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ break;\r
+\r
+ case ICMPV6_TYPE_NEIGHBOR_SOLICIATION:\r
+ // 近隣要請\r
+ if (icmp_info.DataSize < sizeof(ICMPV6_NEIGHBOR_SOLICIATION_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ icmp_info.Headers.NeighborSoliciationHeader =\r
+ (ICMPV6_NEIGHBOR_SOLICIATION_HEADER *)(((UCHAR *)icmp_info.Data));\r
+\r
+ if (ParseICMPv6Options(&icmp_info.OptionList, ((UCHAR *)icmp_info.Headers.HeaderPointer) + sizeof(ICMPV6_NEIGHBOR_SOLICIATION_HEADER),\r
+ icmp_info.DataSize - sizeof(ICMPV6_NEIGHBOR_SOLICIATION_HEADER)) == false)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ break;\r
+\r
+ case ICMPV6_TYPE_NEIGHBOR_ADVERTISEMENT:\r
+ // 近隣広告\r
+ if (icmp_info.DataSize < sizeof(ICMPV6_NEIGHBOR_ADVERTISEMENT_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ icmp_info.Headers.NeighborAdvertisementHeader =\r
+ (ICMPV6_NEIGHBOR_ADVERTISEMENT_HEADER *)(((UCHAR *)icmp_info.Data));\r
+\r
+ if (ParseICMPv6Options(&icmp_info.OptionList, ((UCHAR *)icmp_info.Headers.HeaderPointer) + sizeof(ICMPV6_NEIGHBOR_ADVERTISEMENT_HEADER),\r
+ icmp_info.DataSize - sizeof(ICMPV6_NEIGHBOR_ADVERTISEMENT_HEADER)) == false)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ break;\r
+ }\r
+\r
+ p->TypeL4 = L4_ICMPV6;\r
+ Copy(&p->ICMPv6HeaderPacketInfo, &icmp_info, sizeof(ICMPV6_HEADER_INFO));\r
+\r
+ return true;\r
+}\r
+\r
+// ICMPv6 オプションの解放\r
+void FreeCloneICMPv6Options(ICMPV6_OPTION_LIST *o)\r
+{\r
+ // 引数チェック\r
+ if (o == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ Free(o->SourceLinkLayer);\r
+ Free(o->TargetLinkLayer);\r
+ Free(o->Prefix);\r
+ Free(o->Mtu);\r
+}\r
+\r
+// ICMPv6 オプションのクローン\r
+void CloneICMPv6Options(ICMPV6_OPTION_LIST *dst, ICMPV6_OPTION_LIST *src)\r
+{\r
+ // 引数チェック\r
+ if (dst == NULL || src == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ Zero(dst, sizeof(ICMPV6_OPTION_LIST));\r
+\r
+ dst->SourceLinkLayer = Clone(src->SourceLinkLayer, sizeof(ICMPV6_OPTION_LINK_LAYER));\r
+ dst->TargetLinkLayer = Clone(src->TargetLinkLayer, sizeof(ICMPV6_OPTION_LINK_LAYER));\r
+ dst->Prefix = Clone(src->Prefix, sizeof(ICMPV6_OPTION_PREFIX));\r
+ dst->Mtu = Clone(src->Mtu, sizeof(ICMPV6_OPTION_MTU));\r
+}\r
+\r
+// IPv6 パース\r
+bool ParsePacketIPv6(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ if (ParsePacketIPv6Header(&p->IPv6HeaderPacketInfo, buf, size) == false)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ p->TypeL3 = L3_IPV6;\r
+ p->L3.IPv6Header = p->IPv6HeaderPacketInfo.IPv6Header;\r
+\r
+ if (p->IPv6HeaderPacketInfo.Payload == NULL)\r
+ {\r
+ // ペイロードなし\r
+ return true;\r
+ }\r
+\r
+ buf = p->IPv6HeaderPacketInfo.Payload;\r
+ size = p->IPv6HeaderPacketInfo.PayloadSize;\r
+\r
+ if (p->IPv6HeaderPacketInfo.IsFragment)\r
+ {\r
+ // フラグメントパケットであるからこれ以上解釈しない\r
+ p->TypeL4 = L4_FRAGMENT;\r
+ return true;\r
+ }\r
+\r
+ // L4 パケットのパース\r
+ switch (p->IPv6HeaderPacketInfo.Protocol)\r
+ {\r
+ case IP_PROTO_ICMPV6: // ICMPv6\r
+ if (ParseICMPv6(p, buf, size) == false)\r
+ {\r
+ // ICMPv6 のパースに失敗しても true を返す\r
+ return true;\r
+ }\r
+ else\r
+ {\r
+ return true;\r
+ }\r
+\r
+ case IP_PROTO_TCP: // TCP\r
+ return ParseTCP(p, buf, size);\r
+\r
+ case IP_PROTO_UDP: // UDP\r
+ return ParseUDP(p, buf, size);\r
+\r
+ default: // 不明\r
+ return true;\r
+ }\r
+\r
+ return true;\r
+}\r
+\r
+// IPv4 パース\r
+bool ParsePacketIPv4(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ UINT header_size;\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(IPV4_HEADER))\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // IPv4 ヘッダ\r
+ p->L3.IPv4Header = (IPV4_HEADER *)buf;\r
+ p->TypeL3 = L3_IPV4;\r
+\r
+ // ヘッダのチェック\r
+ header_size = IPV4_GET_HEADER_LEN(p->L3.IPv4Header) * 4;\r
+ if (header_size < sizeof(IPV4_HEADER) || size < header_size)\r
+ {\r
+ // ヘッダサイズが不正\r
+ p->L3.IPv4Header = NULL;\r
+ p->TypeL3= L3_UNKNOWN;\r
+ return true;\r
+ }\r
+\r
+ if (IPV4_GET_OFFSET(p->L3.IPv4Header) != 0)\r
+ {\r
+ // フラグメント化されているからこれ以上解析しない\r
+ p->TypeL4 = L4_FRAGMENT;\r
+ return true;\r
+ }\r
+\r
+ buf += header_size;\r
+ size -= header_size;\r
+\r
+ // L4 パケットのパース\r
+ switch (p->L3.IPv4Header->Protocol)\r
+ {\r
+ case IP_PROTO_ICMPV4: // ICMPv4\r
+ return ParseICMPv4(p, buf, size);\r
+\r
+ case IP_PROTO_UDP: // UDP\r
+ return ParseUDP(p, buf, size);\r
+\r
+ case IP_PROTO_TCP: // TCP\r
+ return ParseTCP(p, buf, size);\r
+\r
+ default: // 不明\r
+ return true;\r
+ }\r
+}\r
+\r
+// ICMPv4 パース\r
+bool ParseICMPv4(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(ICMP_HEADER))\r
+ {\r
+ // サイズが不正\r
+ return false;\r
+ }\r
+\r
+ // ICMPv4 ヘッダ\r
+ p->L4.ICMPHeader = (ICMP_HEADER *)buf;\r
+ p->TypeL4 = L4_ICMPV4;\r
+\r
+ buf += sizeof(ICMP_HEADER);\r
+ size -= sizeof(ICMP_HEADER);\r
+\r
+ return true;\r
+}\r
+\r
+// TCP パース\r
+bool ParseTCP(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ UINT header_size;\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(TCP_HEADER))\r
+ {\r
+ // サイズが不正\r
+ return false;\r
+ }\r
+\r
+ // TCP ヘッダ\r
+ p->L4.TCPHeader = (TCP_HEADER *)buf;\r
+ p->TypeL4 = L4_TCP;\r
+\r
+ // ヘッダサイズをチェック\r
+ header_size = TCP_GET_HEADER_SIZE(p->L4.TCPHeader) * 4;\r
+ if (header_size < sizeof(TCP_HEADER) || size < header_size)\r
+ {\r
+ // ヘッダサイズが不正\r
+ p->L4.TCPHeader = NULL;\r
+ p->TypeL4 = L4_UNKNOWN;\r
+ return true;\r
+ }\r
+\r
+ buf += header_size;\r
+ size -= header_size;\r
+\r
+ return true;\r
+}\r
+\r
+// UDP パース\r
+bool ParseUDP(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ USHORT src_port, dst_port;\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return false;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(UDP_HEADER))\r
+ {\r
+ // サイズが不正\r
+ return false;\r
+ }\r
+\r
+ // UDP ヘッダ\r
+ p->L4.UDPHeader = (UDP_HEADER *)buf;\r
+ p->TypeL4 = L4_UDP;\r
+\r
+ buf += sizeof(UDP_HEADER);\r
+ size -= sizeof(UDP_HEADER);\r
+\r
+ // ポート番号をチェック\r
+ src_port = Endian16(p->L4.UDPHeader->SrcPort);\r
+ dst_port = Endian16(p->L4.UDPHeader->DstPort);\r
+\r
+ if ((src_port == 67 && dst_port == 68) ||\r
+ (src_port == 68 && dst_port == 67))\r
+ {\r
+ if (p->TypeL3 == L3_IPV4)\r
+ {\r
+ // DHCP パケットを発見\r
+ ParseDHCPv4(p, buf, size);\r
+ }\r
+ }\r
+\r
+ return true;\r
+}\r
+\r
+// DHCPv4 パース\r
+void ParseDHCPv4(PKT *p, UCHAR *buf, UINT size)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL || buf == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ // サイズをチェック\r
+ if (size < sizeof(DHCPV4_HEADER))\r
+ {\r
+ // サイズが不正\r
+ return;\r
+ }\r
+\r
+ // DHCPv4 ヘッダ\r
+ p->L7.DHCPv4Header = (DHCPV4_HEADER *)buf;\r
+ p->TypeL7 = L7_DHCPV4;\r
+}\r
+\r
+// パケットのメモリを解放する\r
+void FreePacket(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ if (p->MacHeader != NULL)\r
+ {\r
+ switch (p->TypeL3)\r
+ {\r
+ case L3_IPV4:\r
+ FreePacketIPv4(p);\r
+ break;\r
+\r
+ case L3_ARPV4:\r
+ FreePacketARPv4(p);\r
+ break;\r
+\r
+ case L3_TAGVLAN:\r
+ FreePacketTagVlan(p);\r
+ break;\r
+ }\r
+ }\r
+\r
+ Free(p);\r
+}\r
+\r
+// IPv4 パケットのメモリを解放する\r
+void FreePacketIPv4(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ switch (p->TypeL4)\r
+ {\r
+ case L4_ICMPV4:\r
+ FreePacketICMPv4(p);\r
+ break;\r
+\r
+ case L4_TCP:\r
+ FreePacketTCPv4(p);\r
+ break;\r
+\r
+ case L4_UDP:\r
+ FreePacketUDPv4(p);\r
+ break;\r
+ }\r
+\r
+ p->L3.IPv4Header = NULL;\r
+ p->TypeL3 = L3_UNKNOWN;\r
+}\r
+\r
+// タグ VLAN パケットのメモリを解放する\r
+void FreePacketTagVlan(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ p->L3.TagVlanHeader = NULL;\r
+ p->TypeL3 = L3_UNKNOWN;\r
+}\r
+\r
+// ARPv4 パケットのメモリを解放する\r
+void FreePacketARPv4(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ p->L3.ARPv4Header = NULL;\r
+ p->TypeL3 = L3_UNKNOWN;\r
+}\r
+\r
+// UDPv4 パケットのメモリを解放する\r
+void FreePacketUDPv4(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ switch (p->TypeL7)\r
+ {\r
+ case L7_DHCPV4:\r
+ FreePacketDHCPv4(p);\r
+ break;\r
+ }\r
+\r
+ p->L4.UDPHeader = NULL;\r
+ p->TypeL4 = L4_UNKNOWN;\r
+}\r
+\r
+// TCPv4 パケットのメモリを解放する\r
+void FreePacketTCPv4(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ p->L4.TCPHeader = NULL;\r
+ p->TypeL4 = L4_UNKNOWN;\r
+}\r
+\r
+// ICMPv4 パケットのメモリを解放する\r
+void FreePacketICMPv4(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ p->L4.ICMPHeader = NULL;\r
+ p->TypeL4 = L4_UNKNOWN;\r
+}\r
+\r
+// DHCPv4 パケットのメモリを解放する\r
+void FreePacketDHCPv4(PKT *p)\r
+{\r
+ // 引数チェック\r
+ if (p == NULL)\r
+ {\r
+ return;\r
+ }\r
+\r
+ p->L7.DHCPv4Header = NULL;\r
+ p->TypeL7 = L7_UNKNOWN;\r
+}\r
+\r
projects / lab.git / blobdiff