rbutil/sansapatcher/sansaio-win32.c

   1 /***************************************************************************
   2  *             __________               __   ___.
   3  *   Open      \______   \ ____   ____ |  | _\_ |__   _______  ___
   4  *   Source     |       _//  _ \_/ ___\|  |/ /| __ \ /  _ \  \/  /
   5  *   Jukebox    |    |   (  <_> )  \___|    < | \_\ (  <_> > <  <
   6  *   Firmware   |____|_  /\____/ \___  >__|_ \|___  /\____/__/\_ \
   7  *                     \/            \/     \/    \/            \/
   8  * $Id$
   9  *
  10  * Copyright (C) 2006-2007 Dave Chapman
  11  *
  12  * error(), lock_volume() and unlock_volume() functions and inspiration taken
  13  * from:
  14  *       RawDisk - Direct Disk Read/Write Access for NT/2000/XP
  15  *       Copyright (c) 2003 Jan Kiszka
  16  *       http://www.stud.uni-hannover.de/user/73174/RawDisk/
  17  *
  18  * All files in this archive are subject to the GNU General Public License.
  19  * See the file COPYING in the source tree root for full license agreement.
  20  *
  21  * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
  22  * KIND, either express or implied.
  23  *
  24  ****************************************************************************/
  25
  26 #include <stdio.h>
  27 #include <unistd.h>
  28 #include <fcntl.h>
  29 #include <string.h>
  30 #include <stdlib.h>
  31 #include <sys/types.h>
  32 #include <sys/stat.h>
  33 #ifdef __WIN32__
  34 #include <windows.h>
  35 #include <winioctl.h>
  36 #endif
  37
  38 #include "sansaio.h"
  39
  40 static int lock_volume(HANDLE hDisk)
  41 {
  42   DWORD dummy;
  43
  44   return DeviceIoControl(hDisk, FSCTL_LOCK_VOLUME, NULL, 0, NULL, 0,
  45                          &dummy, NULL);
  46 }
  47
  48 static int unlock_volume(HANDLE hDisk)
  49 {
  50   DWORD dummy;
  51
  52   return DeviceIoControl(hDisk, FSCTL_UNLOCK_VOLUME, NULL, 0, NULL, 0,
  53                          &dummy, NULL);
  54 }
  55
  56 #ifndef RBUTIL
  57 void print_error(char* msg)
  58 {
  59     char* pMsgBuf;
  60
  61     printf(msg);
  62     FormatMessage(FORMAT_MESSAGE_ALLOCATE_BUFFER | FORMAT_MESSAGE_FROM_SYSTEM |
  63                   FORMAT_MESSAGE_IGNORE_INSERTS, NULL, GetLastError(),
  64                   MAKELANGID(LANG_NEUTRAL, SUBLANG_DEFAULT), (LPTSTR)&pMsgBuf,
  65                   0, NULL);
  66     printf(pMsgBuf);
  67     LocalFree(pMsgBuf);
  68 }
  69 #endif
  70 int sansa_open(struct sansa_t* sansa, int silent)
  71 {
  72     DISK_GEOMETRY_EX diskgeometry_ex;
  73     DISK_GEOMETRY diskgeometry;
  74     unsigned long n;
  75
  76     sansa->dh = CreateFileA(sansa->diskname, GENERIC_READ,
  77                     FILE_SHARE_READ | FILE_SHARE_WRITE, NULL, OPEN_EXISTING,
  78                     FILE_FLAG_WRITE_THROUGH | FILE_FLAG_NO_BUFFERING, NULL);
  79
  80     if (sansa->dh == INVALID_HANDLE_VALUE) {
  81         if (!silent) print_error(" Error opening disk: ");
  82         if(GetLastError() == ERROR_ACCESS_DENIED)
  83             return -2;
  84         else
  85             return -1;
  86     }
  87
  88     if (!lock_volume(sansa->dh)) {
  89         if (!silent) print_error(" Error locking disk: ");
  90         return -1;
  91     }
  92
  93     if (!DeviceIoControl(sansa->dh,
  94                          IOCTL_DISK_GET_DRIVE_GEOMETRY_EX,
  95                          NULL,
  96                          0,
  97                          &diskgeometry_ex,
  98                          sizeof(diskgeometry_ex),
  99                          &n,
 100                          NULL)) {
 101         if (!DeviceIoControl(sansa->dh,
 102                              IOCTL_DISK_GET_DRIVE_GEOMETRY,
 103                              NULL,
 104                              0,
 105                              &diskgeometry,
 106                              sizeof(diskgeometry),
 107                              &n,
 108                              NULL)) {
 109             if (!silent) print_error(" Error reading disk geometry: ");
 110             return -1;
 111         } else {
 112             sansa->sector_size=diskgeometry.BytesPerSector;
 113         }
 114     } else {
 115         sansa->sector_size=diskgeometry_ex.Geometry.BytesPerSector;
 116     }
 117
 118     return 0;
 119 }
 120
 121 int sansa_reopen_rw(struct sansa_t* sansa)
 122 {
 123     /* Close existing file and re-open for writing */
 124     unlock_volume(sansa->dh);
 125     CloseHandle(sansa->dh);
 126
 127     sansa->dh = CreateFileA(sansa->diskname, GENERIC_READ | GENERIC_WRITE,
 128                      FILE_SHARE_READ | FILE_SHARE_WRITE, NULL, OPEN_EXISTING,
 129                      FILE_FLAG_WRITE_THROUGH | FILE_FLAG_NO_BUFFERING, NULL);
 130
 131     if (sansa->dh == INVALID_HANDLE_VALUE) {
 132         print_error(" Error opening disk: ");
 133         return -1;
 134     }
 135
 136     if (!lock_volume(sansa->dh)) {
 137         print_error(" Error locking disk: ");
 138         return -1;
 139     }
 140
 141     return 0;
 142 }
 143
 144 int sansa_close(struct sansa_t* sansa)
 145 {
 146     unlock_volume(sansa->dh);
 147     CloseHandle(sansa->dh);
 148     return 0;
 149 }
 150
 151 int sansa_alloc_buffer(unsigned char** sectorbuf, int bufsize)
 152 {
 153     /* The ReadFile function requires a memory buffer aligned to a multiple of
 154        the disk sector size. */
 155     *sectorbuf = (unsigned char*)VirtualAlloc(NULL, bufsize, MEM_COMMIT, PAGE_READWRITE);
 156     if (*sectorbuf == NULL) {
 157         print_error(" Error allocating a buffer: ");
 158         return -1;
 159     }
 160     return 0;
 161 }
 162
 163 int sansa_seek(struct sansa_t* sansa, loff_t pos)
 164 {
 165     LARGE_INTEGER li;
 166
 167     li.QuadPart = pos;
 168
 169     li.LowPart = SetFilePointer (sansa->dh, li.LowPart, &li.HighPart, FILE_BEGIN);
 170
 171     if (li.LowPart == INVALID_SET_FILE_POINTER && GetLastError() != NO_ERROR) {
 172         print_error(" Seek error ");
 173         return -1;
 174     }
 175     return 0;
 176 }
 177
 178 int sansa_read(struct sansa_t* sansa, unsigned char* buf, int nbytes)
 179 {
 180     unsigned long count;
 181
 182     if (!ReadFile(sansa->dh, buf, nbytes, &count, NULL)) {
 183         print_error(" Error reading from disk: ");
 184         return -1;
 185     }
 186
 187     return count;
 188 }
 189
 190 int sansa_write(struct sansa_t* sansa, unsigned char* buf, int nbytes)
 191 {
 192     unsigned long count;
 193
 194     if (!WriteFile(sansa->dh, buf, nbytes, &count, NULL)) {
 195         print_error(" Error writing to disk: ");
 196         return -1;
 197     }
 198
 199     return count;
 200 }