utvpn/utvpn-unix-v101-7101-public/src/Mayaqua/Tick64.c

   1 // SoftEther UT-VPN SourceCode\r
   2 // \r
   3 // Copyright (C) 2004-2010 SoftEther Corporation.\r
   4 // Copyright (C) 2004-2010 University of Tsukuba, Japan.\r
   5 // Copyright (C) 2003-2010 Daiyuu Nobori.\r
   6 // All Rights Reserved.\r
   7 // \r
   8 // http://utvpn.tsukuba.ac.jp/\r
   9 // \r
  10 // This program is free software; you can redistribute it and/or\r
  11 // modify it under the terms of the GNU General Public License\r
  12 // version 2 as published by the Free Software Foundation.\r
  13 // \r
  14 // This program is distributed in the hope that it will be useful,\r
  15 // but WITHOUT ANY WARRANTY; without even the implied warranty of\r
  16 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the\r
  17 // GNU General Public License for more details.\r
  18 // \r
  19 // You should have received a copy of the GNU General Public License version 2\r
  20 // along with this program; if not, write to the Free Software\r
  21 // Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.\r
  22 // \r
  23 // このファイルは GPL バージョン 2 ライセンスで公開されています。\r
  24 // 誰でもこのファイルの内容を複製、改変したり、改変したバージョンを再配布\r
  25 // することができます。ただし、原著作物を改変した場合は、原著作物の著作権表示\r
  26 // を除去することはできません。改変した著作物を配布する場合は、改変実施者の\r
  27 // 著作権表示を原著作物の著作権表示に付随して記載するようにしてください。\r
  28 // \r
  29 // この SoftEther UT-VPN オープンソース・プロジェクトは、日本国の\r
  30 // ソフトイーサ株式会社 (SoftEther Corporation, http://www.softether.co.jp/ )\r
  31 // および筑波大学 (University of Tsukuba, http://www.tsukuba.ac.jp/ ) によって\r
  32 // ホストされています。\r
  33 // 本プログラムの配布者は、本プログラムを、業としての利用以外のため、\r
  34 // および、試験または研究のために利用が行われることを想定して配布\r
  35 // しています。\r
  36 // SoftEther UT-VPN プロジェクトの Web サイトは http://utvpn.tsukuba.ac.jp/ に\r
  37 // あります。\r
  38 // 本ソフトウェアの不具合の修正、機能改良、セキュリティホールの修復などのコード\r
  39 // の改変を行った場合で、その成果物を SoftEther UT-VPN プロジェクトに提出して\r
  40 // いただける場合は、 http://utvpn.tsukuba.ac.jp/ までソースコードを送付して\r
  41 // ください。SoftEther UT-VPN プロジェクトの本体リリースまたはブランチリリース\r
  42 // に組み込みさせていただきます。\r
  43 // \r
  44 // GPL に基づいて原著作物が提供される本ソフトウェアの改良版を配布、販売する\r
  45 // 場合は、そのソースコードを GPL に基づいて誰にでも開示する義務が生じます。\r
  46 // \r
  47 // 本ソフトウェアに関連する著作権、特許権、商標権はソフトイーサ株式会社\r
  48 // (SoftEther Corporation) およびその他の著作権保持者が保有しています。\r
  49 // ソフトイーサ株式会社等はこれらの権利を放棄していません。本ソフトウェアの\r
  50 // 二次著作物を配布、販売する場合は、これらの権利を侵害しないようにご注意\r
  51 // ください。\r
  52 // \r
  53 // お願い: どのような通信ソフトウェアにも通常は必ず未発見の\r
  54 // セキュリティホールが潜んでいます。本ソースコードをご覧いただいた結果、\r
  55 // UT-VPN にセキュリティホールを発見された場合は、当該セキュリティホールの\r
  56 // 情報を不特定多数に開示される前に、必ず、ソフトイーサ株式会社\r
  57 // および脆弱性情報の届出を受け付ける公的機関まで通報いただき、\r
  58 // 公益保護にご協力いただきますようお願い申し上げます。\r
  59 // \r
  60 // ソフトイーサ株式会社は、当該セキュリティホールについて迅速に対処を\r
  61 // 行い、UT-VPN および UT-VPN に関連するソフトウェアのユーザー・顧客\r
  62 // を保護するための努力を行います。\r
  63 // \r
  64 // ソフトイーサへの届出先: http://www.softether.co.jp/jp/contact/\r
  65 // 日本国内の脆弱性情報届出受付公的機関:\r
  66 //         独立行政法人 情報処理推進機構\r
  67 //         http://www.ipa.go.jp/security/vuln/report/\r
  68 // \r
  69 // 上記各事項について不明な点は、ソフトイーサ株式会社までご連絡ください。\r
  70 // 連絡先: http://www.softether.co.jp/jp/contact/\r
  71 \r
  72 // -----------------------------------------------\r
  73 // [ChangeLog]\r
  74 // 2010.05.20\r
  75 //  新規リリース by SoftEther\r
  76 // -----------------------------------------------\r
  77 \r
  78 // Tick64.c\r
  79 // 64bit リアルタイムクロックプログラム\r
  80 \r
  81 #ifdef  WIN32\r
  82 #include <windows.h>\r
  83 #endif  // WIN32\r
  84 \r
  85 \r
  86 #include <stdio.h>\r
  87 #include <stdlib.h>\r
  88 #include <string.h>\r
  89 #include <wchar.h>\r
  90 #include <stdarg.h>\r
  91 #include <locale.h>\r
  92 #include <time.h>\r
  93 #include <errno.h>\r
  94 #include <Mayaqua/Mayaqua.h>\r
  95 \r
  96 static TICK64 *tk64 = NULL;\r
  97 static EVENT *halt_tick_event = NULL;\r
  98 \r
  99 // 高解像度時刻を取得\r
 100 UINT64 TickHighres64()\r
 101 {\r
 102         UINT64 ret = 0;\r
 103 \r
 104 #ifdef  OS_WIN32\r
 105 \r
 106         ret = (UINT64)(MsGetHiResTimeSpan(MsGetHiResCounter()) * 1000.0f);\r
 107 \r
 108 #else   // OS_WIN32\r
 109 \r
 110         return Tick64();\r
 111 \r
 112 #endif  // OS_WIN32\r
 113 \r
 114         return ret;\r
 115 }\r
 116 \r
 117 // Tick 値を時刻に変換\r
 118 UINT64 Tick64ToTime64(UINT64 tick)\r
 119 {\r
 120         UINT64 ret = 0;\r
 121         if (tick == 0)\r
 122         {\r
 123                 return 0;\r
 124         }\r
 125         LockList(tk64->AdjustTime);\r
 126         {\r
 127                 UINT i;\r
 128                 for (i = 0;i < LIST_NUM(tk64->AdjustTime);i++)\r
 129                 {\r
 130                         ADJUST_TIME *t = LIST_DATA(tk64->AdjustTime, i);\r
 131                         if (t->Tick <= tick)\r
 132                         {\r
 133                                 ret = t->Time + (tick - t->Tick);\r
 134                         }\r
 135                 }\r
 136         }\r
 137         UnlockList(tk64->AdjustTime);\r
 138         if (ret == 0)\r
 139         {\r
 140                 ret++;\r
 141         }\r
 142         return ret;\r
 143 }\r
 144 \r
 145 // Tick 値を時刻に変換\r
 146 UINT64 TickToTime(UINT64 tick)\r
 147 {\r
 148         return Tick64ToTime64(tick);\r
 149 }\r
 150 \r
 151 // Tick 値を取得\r
 152 UINT64 Tick64()\r
 153 {\r
 154 #ifdef  OS_WIN32\r
 155         return Win32FastTick64();\r
 156 #else   // OS_WIN32\r
 157         UINT64 tick64;\r
 158         if (tk64 == NULL)\r
 159         {\r
 160                 return 0;\r
 161         }\r
 162         Lock(tk64->TickLock);\r
 163         {\r
 164                 tick64 = tk64->Tick;\r
 165         }\r
 166         Unlock(tk64->TickLock);\r
 167         return tick64;\r
 168 #endif  // OS_WIN32\r
 169 }\r
 170 \r
 171 // リアルタイムクロック測定用スレッド\r
 172 void Tick64Thread(THREAD *thread, void *param)\r
 173 {\r
 174         UINT n = 0;\r
 175         bool first = false;\r
 176         bool create_first_entry = true;\r
 177         UINT tick_span;\r
 178         // 引数チェック\r
 179         if (thread == NULL)\r
 180         {\r
 181                 return;\r
 182         }\r
 183 \r
 184 #ifdef  OS_WIN32\r
 185 \r
 186         // Win32 スレッドの優先順位を上げる\r
 187         MsSetThreadPriorityRealtime();\r
 188 \r
 189         tick_span = TICK64_SPAN_WIN32;\r
 190 \r
 191 #else   // OS_WIN32\r
 192 \r
 193         // POSIX スレッドの優先順位を上げる\r
 194         UnixSetThreadPriorityRealtime();\r
 195 \r
 196         tick_span = TICK64_SPAN;\r
 197 \r
 198 #endif  // OS_WIN32\r
 199 \r
 200         while (true)\r
 201         {\r
 202                 UINT tick;\r
 203                 UINT64 tick64;\r
 204 \r
 205 #ifndef OS_WIN32\r
 206                 tick = TickRealtime();          // 現在のシステムクロックを取得\r
 207 \r
 208                 if (tk64->LastTick > tick)\r
 209                 {\r
 210                         if ((tk64->LastTick - tick) >= (UINT64)0x0fffffff)\r
 211                         {\r
 212                                 // tick の値が 1 周した\r
 213                                 tk64->RoundCount++;\r
 214                         }\r
 215                         else\r
 216                         {\r
 217                                 // tick の値が逆戻りした (システム管理者がハードウェア時計を変更した)\r
 218                                 // 通常これは 1 秒以内の誤差として発生する\r
 219                                 tick = tk64->LastTick;\r
 220                         }\r
 221                 }\r
 222                 tk64->LastTick = tick;\r
 223 \r
 224                 tick64 = (UINT64)tk64->RoundCount * (UINT64)4294967296LL + (UINT64)tick;\r
 225 \r
 226                 Lock(tk64->TickLock);\r
 227                 {\r
 228                         if (tk64->TickStart == 0)\r
 229                         {\r
 230                                 tk64->TickStart = tick64;\r
 231                         }\r
 232                         tick64 = tk64->Tick = tick64 - tk64->TickStart + (UINT64)1;\r
 233                 }\r
 234                 Unlock(tk64->TickLock);\r
 235 #else   // OS_WIN32\r
 236                 tick64 = Win32FastTick64();\r
 237                 tick = (UINT)tick64;\r
 238 #endif  // OS_WIN32\r
 239 \r
 240                 if (create_first_entry)\r
 241                 {\r
 242                         ADJUST_TIME *t = ZeroMalloc(sizeof(ADJUST_TIME));\r
 243                         t->Tick = tick64;\r
 244                         t->Time = SystemTime64();\r
 245                         tk64->Tick64WithTime64 = tick64;\r
 246                         tk64->Time64 = t->Time;\r
 247                         Add(tk64->AdjustTime, t);\r
 248 \r
 249                         // 初期化完了を通知\r
 250                         NoticeThreadInit(thread);\r
 251                         create_first_entry = false;\r
 252                 }\r
 253 \r
 254                 // 時刻補正\r
 255                 n += tick_span;\r
 256                 if (n >= 1000 || first == false)\r
 257                 {\r
 258                         UINT64 now = SystemTime64();\r
 259 \r
 260                         if (now < tk64->Time64 ||\r
 261                                 Diff64((now - tk64->Time64) + tk64->Tick64WithTime64, tick64) >= tick_span)\r
 262                         {\r
 263                                 ADJUST_TIME *t = ZeroMalloc(sizeof(ADJUST_TIME));\r
 264                                 LockList(tk64->AdjustTime);\r
 265                                 {\r
 266                                         t->Tick = tick64;\r
 267                                         t->Time = now;\r
 268                                         Add(tk64->AdjustTime, t);\r
 269                                         Debug("Adjust Time: Tick = %I64u, Time = %I64u\n",\r
 270                                                 t->Tick, t->Time);\r
 271 \r
 272                                         // 時計が狂っているシステムでメモリを無限に食わないように\r
 273                                         if (LIST_NUM(tk64->AdjustTime) > MAX_ADJUST_TIME)\r
 274                                         {\r
 275                                                 // 2 個目を削除する\r
 276                                                 ADJUST_TIME *t2 = LIST_DATA(tk64->AdjustTime, 1);\r
 277 \r
 278                                                 Delete(tk64->AdjustTime, t2);\r
 279 \r
 280                                                 Debug("NUM_ADJUST TIME: %u\n", LIST_NUM(tk64->AdjustTime));\r
 281 \r
 282                                                 Free(t2);\r
 283                                         }\r
 284                                 }\r
 285                                 UnlockList(tk64->AdjustTime);\r
 286                                 tk64->Time64 = now;\r
 287                                 tk64->Tick64WithTime64 = tick64;\r
 288                         }\r
 289                         first = true;\r
 290                         n = 0;\r
 291                 }\r
 292 \r
 293                 if (tk64->Halt)\r
 294                 {\r
 295                         break;\r
 296                 }\r
 297 \r
 298 #ifdef  OS_WIN32\r
 299                 Wait(halt_tick_event, tick_span);\r
 300 #else   // OS_WIN32\r
 301                 SleepThread(tick_span);\r
 302 #endif  // OS_WIN32\r
 303         }\r
 304 }\r
 305 \r
 306 // 2 つの 64 bit 整数の差の絶対値を取得\r
 307 UINT64 Diff64(UINT64 a, UINT64 b)\r
 308 {\r
 309         if (a > b)\r
 310         {\r
 311                 return a - b;\r
 312         }\r
 313         else\r
 314         {\r
 315                 return b - a;\r
 316         }\r
 317 }\r
 318 \r
 319 // Tick64 の初期化\r
 320 void InitTick64()\r
 321 {\r
 322         if (tk64 != NULL)\r
 323         {\r
 324                 // すでに初期化されている\r
 325                 return;\r
 326         }\r
 327 \r
 328         halt_tick_event = NewEvent();\r
 329 \r
 330         // 構造体の初期化\r
 331         tk64 = ZeroMalloc(sizeof(TICK64));\r
 332         tk64->TickLock = NewLock();\r
 333         tk64->AdjustTime = NewList(NULL);\r
 334 \r
 335         // スレッドの作成\r
 336         tk64->Thread = NewThread(Tick64Thread, NULL);\r
 337         WaitThreadInit(tk64->Thread);\r
 338 }\r
 339 \r
 340 // Tick64 の解放\r
 341 void FreeTick64()\r
 342 {\r
 343         UINT i;\r
 344         if (tk64 == NULL)\r
 345         {\r
 346                 // 初期化されていない\r
 347                 return;\r
 348         }\r
 349 \r
 350         // 終了処理\r
 351         tk64->Halt = true;\r
 352         Set(halt_tick_event);\r
 353         WaitThread(tk64->Thread, INFINITE);\r
 354         ReleaseThread(tk64->Thread);\r
 355 \r
 356         // 解放処理\r
 357         for (i = 0;i < LIST_NUM(tk64->AdjustTime);i++)\r
 358         {\r
 359                 ADJUST_TIME *t = LIST_DATA(tk64->AdjustTime, i);\r
 360                 Free(t);\r
 361         }\r
 362         ReleaseList(tk64->AdjustTime);\r
 363         DeleteLock(tk64->TickLock);\r
 364         Free(tk64);\r
 365         tk64 = NULL;\r
 366 \r
 367         ReleaseEvent(halt_tick_event);\r
 368         halt_tick_event = NULL;\r
 369 }\r
 370 \r