Hardware/Ring0.cs
author moel.mich
Sat, 16 Apr 2011 19:26:20 +0000
changeset 273 2054d5dcb680
parent 256 6dc6410489f4
child 279 6bce967ba1b5
permissions -rw-r--r--
A first correction for reading core and bus clocks on AMD family 14h CPUs.
moel@236
     1
/*
moel@236
     2
  
moel@236
     3
  Version: MPL 1.1/GPL 2.0/LGPL 2.1
moel@236
     4
moel@236
     5
  The contents of this file are subject to the Mozilla Public License Version
moel@236
     6
  1.1 (the "License"); you may not use this file except in compliance with
moel@236
     7
  the License. You may obtain a copy of the License at
moel@236
     8
 
moel@236
     9
  http://www.mozilla.org/MPL/
moel@236
    10
moel@236
    11
  Software distributed under the License is distributed on an "AS IS" basis,
moel@236
    12
  WITHOUT WARRANTY OF ANY KIND, either express or implied. See the License
moel@236
    13
  for the specific language governing rights and limitations under the License.
moel@236
    14
moel@236
    15
  The Original Code is the Open Hardware Monitor code.
moel@236
    16
moel@236
    17
  The Initial Developer of the Original Code is 
moel@236
    18
  Michael Möller <m.moeller@gmx.ch>.
moel@254
    19
  Portions created by the Initial Developer are Copyright (C) 2010-2011
moel@236
    20
  the Initial Developer. All Rights Reserved.
moel@236
    21
moel@236
    22
  Contributor(s):
moel@236
    23
moel@236
    24
  Alternatively, the contents of this file may be used under the terms of
moel@236
    25
  either the GNU General Public License Version 2 or later (the "GPL"), or
moel@236
    26
  the GNU Lesser General Public License Version 2.1 or later (the "LGPL"),
moel@236
    27
  in which case the provisions of the GPL or the LGPL are applicable instead
moel@236
    28
  of those above. If you wish to allow use of your version of this file only
moel@236
    29
  under the terms of either the GPL or the LGPL, and not to allow others to
moel@236
    30
  use your version of this file under the terms of the MPL, indicate your
moel@236
    31
  decision by deleting the provisions above and replace them with the notice
moel@236
    32
  and other provisions required by the GPL or the LGPL. If you do not delete
moel@236
    33
  the provisions above, a recipient may use your version of this file under
moel@236
    34
  the terms of any one of the MPL, the GPL or the LGPL.
moel@236
    35
 
moel@236
    36
*/
moel@236
    37
moel@236
    38
using System;
moel@236
    39
using System.IO;
moel@236
    40
using System.Reflection;
moel@236
    41
using System.Runtime.InteropServices;
moel@236
    42
using System.Threading;
moel@254
    43
using System.Text;
moel@236
    44
moel@236
    45
namespace OpenHardwareMonitor.Hardware {
moel@236
    46
  internal static class Ring0 {
moel@236
    47
moel@236
    48
    private static KernelDriver driver;
moel@236
    49
    private static Mutex isaBusMutex;
moel@254
    50
    private static readonly StringBuilder report = new StringBuilder();
moel@236
    51
moel@236
    52
    private const uint OLS_TYPE = 40000;
moel@236
    53
    private static IOControlCode
moel@236
    54
      IOCTL_OLS_GET_REFCOUNT = new IOControlCode(OLS_TYPE, 0x801,
moel@236
    55
        IOControlCode.Access.Any),
moel@236
    56
      IOCTL_OLS_GET_DRIVER_VERSION = new IOControlCode(OLS_TYPE, 0x800,
moel@236
    57
        IOControlCode.Access.Any),
moel@236
    58
      IOCTL_OLS_READ_MSR = new IOControlCode(OLS_TYPE, 0x821,
moel@236
    59
        IOControlCode.Access.Any),
moel@236
    60
      IOCTL_OLS_WRITE_MSR = new IOControlCode(OLS_TYPE, 0x822, 
moel@236
    61
        IOControlCode.Access.Any),
moel@236
    62
      IOCTL_OLS_READ_IO_PORT_BYTE = new IOControlCode(OLS_TYPE, 0x833,
moel@236
    63
        IOControlCode.Access.Read),
moel@236
    64
      IOCTL_OLS_WRITE_IO_PORT_BYTE = new IOControlCode(OLS_TYPE, 0x836, 
moel@236
    65
        IOControlCode.Access.Write),
moel@236
    66
      IOCTL_OLS_READ_PCI_CONFIG = new IOControlCode(OLS_TYPE, 0x851, 
moel@236
    67
        IOControlCode.Access.Read),
moel@236
    68
      IOCTL_OLS_WRITE_PCI_CONFIG = new IOControlCode(OLS_TYPE, 0x852,
moel@236
    69
        IOControlCode.Access.Write);
moel@236
    70
moel@236
    71
    private static bool ExtractDriver(string fileName) {
moel@236
    72
      string resourceName = "OpenHardwareMonitor.Hardware." +
moel@236
    73
        (IntPtr.Size == 4 ? "WinRing0.sys" : "WinRing0x64.sys");
moel@236
    74
moel@236
    75
      string[] names =
moel@236
    76
        Assembly.GetExecutingAssembly().GetManifestResourceNames();
moel@236
    77
      byte[] buffer = null;
moel@236
    78
      for (int i = 0; i < names.Length; i++) {
moel@236
    79
        if (names[i].Replace('\\', '.') == resourceName) {
moel@236
    80
          using (Stream stream = Assembly.GetExecutingAssembly().
moel@236
    81
            GetManifestResourceStream(names[i])) 
moel@236
    82
          {
moel@236
    83
              buffer = new byte[stream.Length];
moel@236
    84
              stream.Read(buffer, 0, buffer.Length);
moel@236
    85
          }
moel@236
    86
        }
moel@236
    87
      }
moel@236
    88
moel@236
    89
      if (buffer == null)
moel@236
    90
        return false;
moel@236
    91
moel@236
    92
      using (FileStream target = new FileStream(fileName, FileMode.Create)) {
moel@236
    93
        target.Write(buffer, 0, buffer.Length);
moel@236
    94
      }
moel@236
    95
moel@236
    96
      return true;
moel@236
    97
    }
moel@236
    98
moel@236
    99
    public static void Open() {
moel@254
   100
      // no implementation for unix systems
moel@238
   101
      int p = (int)Environment.OSVersion.Platform;
moel@238
   102
      if ((p == 4) || (p == 128))
moel@238
   103
        return;  
moel@238
   104
      
moel@236
   105
      if (driver != null)
moel@236
   106
        return;
moel@254
   107
moel@254
   108
      // clear the current report
moel@254
   109
      report.Length = 0;
moel@236
   110
     
moel@236
   111
      driver = new KernelDriver("WinRing0_1_2_0");
moel@236
   112
      driver.Open();
moel@236
   113
moel@236
   114
      if (!driver.IsOpen) {
moel@255
   115
        // driver is not loaded, try to reinstall and open
moel@255
   116
moel@255
   117
        driver.Delete();
moel@236
   118
        string fileName = Path.GetTempFileName();
moel@236
   119
        if (ExtractDriver(fileName)) {
moel@254
   120
          if (driver.Install(fileName)) {
moel@254
   121
            File.Delete(fileName);
moel@254
   122
            driver.Open();
moel@236
   123
moel@254
   124
            if (!driver.IsOpen) {
moel@254
   125
              driver.Delete();
moel@254
   126
              report.AppendLine("Status: Opening driver failed");
moel@254
   127
            }
moel@254
   128
          } else {
moel@255
   129
            report.AppendLine("Status: Installing driver \"" + 
moel@255
   130
              fileName + "\" failed" + 
moel@255
   131
              (File.Exists(fileName) ? " and file exists" : ""));
moel@254
   132
            report.AppendLine();
moel@254
   133
            report.Append("Exception: " + Marshal.GetExceptionForHR(
moel@254
   134
              Marshal.GetHRForLastWin32Error()).Message);
moel@254
   135
          }
moel@254
   136
        } else {
moel@254
   137
          report.AppendLine(
moel@254
   138
            "Status: Extracting driver to \"" + fileName + "\" failed");
moel@236
   139
        }
moel@236
   140
      }
moel@236
   141
moel@236
   142
      if (!driver.IsOpen) 
moel@236
   143
        driver = null;
moel@236
   144
moel@259
   145
      isaBusMutex = new Mutex(false, "Global\\Access_ISABUS.HTP.Method");
moel@236
   146
    }
moel@236
   147
moel@236
   148
    public static bool IsOpen {
moel@236
   149
      get { return driver != null; }
moel@236
   150
    }
moel@236
   151
moel@236
   152
    public static void Close() {
moel@236
   153
      if (driver == null)
moel@236
   154
        return;
moel@236
   155
moel@236
   156
      uint refCount = 0;
moel@236
   157
      driver.DeviceIOControl(IOCTL_OLS_GET_REFCOUNT, null, ref refCount);
moel@236
   158
moel@236
   159
      driver.Close();
moel@236
   160
moel@236
   161
      if (refCount <= 1)
moel@236
   162
        driver.Delete();
moel@236
   163
moel@236
   164
      driver = null;
moel@236
   165
moel@236
   166
      isaBusMutex.Close(); 
moel@236
   167
    }
moel@236
   168
moel@254
   169
    public static string GetReport() {
moel@254
   170
      if (report.Length > 0) {
moel@256
   171
        StringBuilder r = new StringBuilder();
moel@256
   172
        r.AppendLine("Ring0");
moel@256
   173
        r.AppendLine();
moel@256
   174
        r.Append(report);
moel@256
   175
        r.AppendLine();
moel@256
   176
        return r.ToString();
moel@254
   177
      } else
moel@254
   178
        return null;
moel@254
   179
    }
moel@254
   180
moel@236
   181
    public static bool WaitIsaBusMutex(int millisecondsTimeout) {
moel@236
   182
      try {
moel@236
   183
        return isaBusMutex.WaitOne(millisecondsTimeout, false);
moel@236
   184
      } catch (AbandonedMutexException) { return false; } 
moel@236
   185
        catch (InvalidOperationException) { return false; }
moel@236
   186
    }
moel@236
   187
moel@236
   188
    public static void ReleaseIsaBusMutex() {
moel@236
   189
      isaBusMutex.ReleaseMutex();
moel@236
   190
    }
moel@236
   191
moel@236
   192
    public static bool Rdmsr(uint index, out uint eax, out uint edx) {
moel@236
   193
      if (driver == null) {
moel@236
   194
        eax = 0;
moel@236
   195
        edx = 0;
moel@236
   196
        return false;
moel@236
   197
      }
moel@236
   198
moel@236
   199
      ulong buffer = 0;
moel@236
   200
      bool result = driver.DeviceIOControl(IOCTL_OLS_READ_MSR, index,
moel@236
   201
        ref buffer);
moel@236
   202
moel@236
   203
      edx = (uint)((buffer >> 32) & 0xFFFFFFFF);
moel@236
   204
      eax = (uint)(buffer & 0xFFFFFFFF);
moel@236
   205
      return result;
moel@236
   206
    }
moel@236
   207
moel@236
   208
    public static bool RdmsrTx(uint index, out uint eax, out uint edx,
moel@238
   209
      ulong threadAffinityMask) 
moel@236
   210
    {
moel@238
   211
      ulong mask = ThreadAffinity.Set(threadAffinityMask);
moel@236
   212
moel@236
   213
      bool result = Rdmsr(index, out eax, out edx);
moel@236
   214
moel@238
   215
      ThreadAffinity.Set(mask);
moel@236
   216
      return result;
moel@236
   217
    }
moel@236
   218
moel@236
   219
    [StructLayout(LayoutKind.Sequential, Pack = 1)]
moel@236
   220
    private struct WrmsrInput {
moel@236
   221
      public uint Register;
moel@236
   222
      public ulong Value;
moel@236
   223
    }
moel@236
   224
moel@236
   225
    public static bool Wrmsr(uint index, uint eax, uint edx) {
moel@236
   226
      if (driver == null)
moel@236
   227
        return false;
moel@236
   228
moel@236
   229
      WrmsrInput input = new WrmsrInput();
moel@236
   230
      input.Register = index;
moel@236
   231
      input.Value = ((ulong)edx << 32) | eax;
moel@236
   232
moel@236
   233
      return driver.DeviceIOControl(IOCTL_OLS_WRITE_MSR, input);
moel@236
   234
    }
moel@236
   235
moel@236
   236
    public static byte ReadIoPort(uint port) {
moel@236
   237
      if (driver == null)
moel@236
   238
        return 0;
moel@236
   239
moel@236
   240
      uint value = 0;
moel@236
   241
      driver.DeviceIOControl(IOCTL_OLS_READ_IO_PORT_BYTE, port, ref value);
moel@236
   242
moel@236
   243
      return (byte)(value & 0xFF);
moel@236
   244
    }
moel@236
   245
moel@236
   246
    [StructLayout(LayoutKind.Sequential, Pack = 1)]
moel@236
   247
    private struct WriteIoPortInput {
moel@236
   248
      public uint PortNumber;
moel@236
   249
      public byte Value;
moel@236
   250
    }
moel@236
   251
moel@236
   252
    public static void WriteIoPort(uint port, byte value) {
moel@236
   253
      if (driver == null)
moel@236
   254
        return;
moel@236
   255
moel@236
   256
      WriteIoPortInput input = new WriteIoPortInput();
moel@236
   257
      input.PortNumber = port;
moel@236
   258
      input.Value = value;
moel@236
   259
moel@236
   260
      driver.DeviceIOControl(IOCTL_OLS_WRITE_IO_PORT_BYTE, input);
moel@236
   261
    }
moel@236
   262
moel@236
   263
    public const uint InvalidPciAddress = 0xFFFFFFFF;
moel@236
   264
moel@236
   265
    public static uint GetPciAddress(byte bus, byte device, byte function) {
moel@236
   266
      return
moel@236
   267
        (uint)(((bus & 0xFF) << 8) | ((device & 0x1F) << 3) | (function & 7));
moel@236
   268
    }
moel@236
   269
moel@236
   270
    [StructLayout(LayoutKind.Sequential, Pack = 1)]
moel@236
   271
    private struct ReadPciConfigInput {
moel@236
   272
      public uint PciAddress;
moel@236
   273
      public uint RegAddress;
moel@236
   274
    }
moel@236
   275
moel@236
   276
    public static bool ReadPciConfig(uint pciAddress, uint regAddress, 
moel@236
   277
      out uint value) 
moel@236
   278
    {
moel@236
   279
      if (driver == null || (regAddress & 3) != 0) {
moel@236
   280
        value = 0;
moel@236
   281
        return false;
moel@236
   282
      }
moel@236
   283
moel@236
   284
      ReadPciConfigInput input = new ReadPciConfigInput();
moel@236
   285
      input.PciAddress = pciAddress;
moel@236
   286
      input.RegAddress = regAddress;
moel@236
   287
moel@236
   288
      value = 0;
moel@236
   289
      return driver.DeviceIOControl(IOCTL_OLS_READ_PCI_CONFIG, input, 
moel@236
   290
        ref value);
moel@236
   291
    }
moel@236
   292
moel@236
   293
    [StructLayout(LayoutKind.Sequential, Pack = 1)]
moel@236
   294
    private struct WritePciConfigInput {
moel@236
   295
      public uint PciAddress;
moel@236
   296
      public uint RegAddress;
moel@236
   297
      public uint Value;
moel@236
   298
    }
moel@236
   299
moel@236
   300
    public static bool WritePciConfig(uint pciAddress, uint regAddress, 
moel@236
   301
      uint value) 
moel@236
   302
    {
moel@236
   303
      if (driver == null || (regAddress & 3) != 0)
moel@236
   304
        return false;
moel@236
   305
moel@236
   306
      WritePciConfigInput input = new WritePciConfigInput();
moel@236
   307
      input.PciAddress = pciAddress;
moel@236
   308
      input.RegAddress = regAddress;
moel@236
   309
      input.Value = value;
moel@236
   310
moel@236
   311
      return driver.DeviceIOControl(IOCTL_OLS_WRITE_PCI_CONFIG, input);
moel@236
   312
    }
moel@236
   313
  }
moel@236
   314
}