• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /**
2  * device.c - Low level device io functions. Originated from the Linux-NTFS project.
3  *
4  * Copyright (c) 2004-2013 Anton Altaparmakov
5  * Copyright (c) 2004-2006 Szabolcs Szakacsits
6  * Copyright (c) 2010      Jean-Pierre Andre
7  * Copyright (c) 2008-2013 Tuxera Inc.
8  *
9  * This program/include file is free software; you can redistribute it and/or
10  * modify it under the terms of the GNU General Public License as published
11  * by the Free Software Foundation; either version 2 of the License, or
12  * (at your option) any later version.
13  *
14  * This program/include file is distributed in the hope that it will be
15  * useful, but WITHOUT ANY WARRANTY; without even the implied warranty
16  * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  * GNU General Public License for more details.
18  *
19  * You should have received a copy of the GNU General Public License
20  * along with this program (in the main directory of the NTFS-3G
21  * distribution in the file COPYING); if not, write to the Free Software
22  * Foundation,Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
23  */
24 
25 #ifdef HAVE_CONFIG_H
26 #include "config.h"
27 #endif
28 
29 #ifdef HAVE_UNISTD_H
30 #include <unistd.h>
31 #endif
32 #ifdef HAVE_STDLIB_H
33 #include <stdlib.h>
34 #endif
35 #ifdef HAVE_STRING_H
36 #include <string.h>
37 #endif
38 #ifdef HAVE_ERRNO_H
39 #include <errno.h>
40 #endif
41 #ifdef HAVE_STDIO_H
42 #include <stdio.h>
43 #endif
44 #ifdef HAVE_SYS_TYPES_H
45 #include <sys/types.h>
46 #endif
47 #ifdef HAVE_SYS_STAT_H
48 #include <sys/stat.h>
49 #endif
50 #ifdef HAVE_FCNTL_H
51 #include <fcntl.h>
52 #endif
53 #ifdef HAVE_SYS_IOCTL_H
54 #include <sys/ioctl.h>
55 #endif
56 #ifdef HAVE_SYS_PARAM_H
57 #include <sys/param.h>
58 #endif
59 #ifdef HAVE_SYS_MOUNT_H
60 #include <sys/mount.h>
61 #endif
62 #ifdef HAVE_SYS_DISK_H
63 #include <sys/disk.h>
64 #endif
65 #ifdef HAVE_LINUX_FD_H
66 #include <linux/fd.h>
67 #endif
68 #ifdef HAVE_LINUX_HDREG_H
69 #include <linux/hdreg.h>
70 #endif
71 #ifdef ENABLE_HD
72 #include <hd.h>
73 #endif
74 
75 #include "types.h"
76 #include "mst.h"
77 #include "debug.h"
78 #include "device.h"
79 #include "logging.h"
80 #include "misc.h"
81 
82 #if defined(linux) && defined(_IO) && !defined(BLKGETSIZE)
83 #define BLKGETSIZE	_IO(0x12,96)  /* Get device size in 512-byte blocks. */
84 #endif
85 #if defined(linux) && defined(_IOR) && !defined(BLKGETSIZE64)
86 #define BLKGETSIZE64	_IOR(0x12,114,size_t)	/* Get device size in bytes. */
87 #endif
88 #if defined(linux) && !defined(HDIO_GETGEO)
89 #define HDIO_GETGEO	0x0301	/* Get device geometry. */
90 #endif
91 #if defined(linux) && defined(_IO) && !defined(BLKSSZGET)
92 #	define BLKSSZGET _IO(0x12,104) /* Get device sector size in bytes. */
93 #endif
94 #if defined(linux) && defined(_IO) && !defined(BLKBSZSET)
95 #	define BLKBSZSET _IOW(0x12,113,size_t) /* Set device block size in bytes. */
96 #endif
97 
98 /**
99  * ntfs_device_alloc - allocate an ntfs device structure and pre-initialize it
100  * @name:	name of the device (must be present)
101  * @state:	initial device state (usually zero)
102  * @dops:	ntfs device operations to use with the device (must be present)
103  * @priv_data:	pointer to private data (optional)
104  *
105  * Allocate an ntfs device structure and pre-initialize it with the user-
106  * specified device operations @dops, device state @state, device name @name,
107  * and optional private data @priv_data.
108  *
109  * Note, @name is copied and can hence be freed after this functions returns.
110  *
111  * On success return a pointer to the allocated ntfs device structure and on
112  * error return NULL with errno set to the error code returned by ntfs_malloc().
113  */
ntfs_device_alloc(const char * name,const long state,struct ntfs_device_operations * dops,void * priv_data)114 struct ntfs_device *ntfs_device_alloc(const char *name, const long state,
115 		struct ntfs_device_operations *dops, void *priv_data)
116 {
117 	struct ntfs_device *dev;
118 
119 	if (!name) {
120 		errno = EINVAL;
121 		return NULL;
122 	}
123 
124 	dev = ntfs_malloc(sizeof(struct ntfs_device));
125 	if (dev) {
126 		if (!(dev->d_name = strdup(name))) {
127 			int eo = errno;
128 			free(dev);
129 			errno = eo;
130 			return NULL;
131 		}
132 		dev->d_ops = dops;
133 		dev->d_state = state;
134 		dev->d_private = priv_data;
135 		dev->d_heads = -1;
136 		dev->d_sectors_per_track = -1;
137 	}
138 	return dev;
139 }
140 
141 /**
142  * ntfs_device_free - free an ntfs device structure
143  * @dev:	ntfs device structure to free
144  *
145  * Free the ntfs device structure @dev.
146  *
147  * Return 0 on success or -1 on error with errno set to the error code. The
148  * following error codes are defined:
149  *	EINVAL		Invalid pointer @dev.
150  *	EBUSY		Device is still open. Close it before freeing it!
151  */
ntfs_device_free(struct ntfs_device * dev)152 int ntfs_device_free(struct ntfs_device *dev)
153 {
154 	if (!dev) {
155 		errno = EINVAL;
156 		return -1;
157 	}
158 	if (NDevOpen(dev)) {
159 		errno = EBUSY;
160 		return -1;
161 	}
162 	free(dev->d_name);
163 	free(dev);
164 	return 0;
165 }
166 
167 /*
168  *		Sync the device
169  *
170  *	returns zero if successful.
171  */
172 
ntfs_device_sync(struct ntfs_device * dev)173 int ntfs_device_sync(struct ntfs_device *dev)
174 {
175 	int ret;
176 	struct ntfs_device_operations *dops;
177 
178 	if (NDevDirty(dev)) {
179 		dops = dev->d_ops;
180 		ret = dops->sync(dev);
181 	} else
182 		ret = 0;
183 	return ret;
184 }
185 
186 /**
187  * ntfs_pread - positioned read from disk
188  * @dev:	device to read from
189  * @pos:	position in device to read from
190  * @count:	number of bytes to read
191  * @b:		output data buffer
192  *
193  * This function will read @count bytes from device @dev at position @pos into
194  * the data buffer @b.
195  *
196  * On success, return the number of successfully read bytes. If this number is
197  * lower than @count this means that we have either reached end of file or
198  * encountered an error during the read so that the read is partial. 0 means
199  * end of file or nothing to read (@count is 0).
200  *
201  * On error and nothing has been read, return -1 with errno set appropriately
202  * to the return code of either seek, read, or set to EINVAL in case of
203  * invalid arguments.
204  */
ntfs_pread(struct ntfs_device * dev,const s64 pos,s64 count,void * b)205 s64 ntfs_pread(struct ntfs_device *dev, const s64 pos, s64 count, void *b)
206 {
207 	s64 br, total;
208 	struct ntfs_device_operations *dops;
209 
210 	ntfs_log_trace("pos %lld, count %lld\n",(long long)pos,(long long)count);
211 
212 	if (!b || count < 0 || pos < 0) {
213 		errno = EINVAL;
214 		return -1;
215 	}
216 	if (!count)
217 		return 0;
218 
219 	dops = dev->d_ops;
220 
221 	for (total = 0; count; count -= br, total += br) {
222 		br = dops->pread(dev, (char*)b + total, count, pos + total);
223 		/* If everything ok, continue. */
224 		if (br > 0)
225 			continue;
226 		/* If EOF or error return number of bytes read. */
227 		if (!br || total)
228 			return total;
229 		/* Nothing read and error, return error status. */
230 		return br;
231 	}
232 	/* Finally, return the number of bytes read. */
233 	return total;
234 }
235 
236 /**
237  * ntfs_pwrite - positioned write to disk
238  * @dev:	device to write to
239  * @pos:	position in file descriptor to write to
240  * @count:	number of bytes to write
241  * @b:		data buffer to write to disk
242  *
243  * This function will write @count bytes from data buffer @b to the device @dev
244  * at position @pos.
245  *
246  * On success, return the number of successfully written bytes. If this number
247  * is lower than @count this means that the write has been interrupted in
248  * flight or that an error was encountered during the write so that the write
249  * is partial. 0 means nothing was written (also return 0 when @count is 0).
250  *
251  * On error and nothing has been written, return -1 with errno set
252  * appropriately to the return code of either seek, write, or set
253  * to EINVAL in case of invalid arguments.
254  */
ntfs_pwrite(struct ntfs_device * dev,const s64 pos,s64 count,const void * b)255 s64 ntfs_pwrite(struct ntfs_device *dev, const s64 pos, s64 count,
256 		const void *b)
257 {
258 	s64 written, total, ret = -1;
259 	struct ntfs_device_operations *dops;
260 
261 	ntfs_log_trace("pos %lld, count %lld\n",(long long)pos,(long long)count);
262 
263 	if (!b || count < 0 || pos < 0) {
264 		errno = EINVAL;
265 		goto out;
266 	}
267 	if (!count)
268 		return 0;
269 	if (NDevReadOnly(dev)) {
270 		errno = EROFS;
271 		goto out;
272 	}
273 
274 	dops = dev->d_ops;
275 
276 	NDevSetDirty(dev);
277 	for (total = 0; count; count -= written, total += written) {
278 		written = dops->pwrite(dev, (const char*)b + total, count,
279 				       pos + total);
280 		/* If everything ok, continue. */
281 		if (written > 0)
282 			continue;
283 		/*
284 		 * If nothing written or error return number of bytes written.
285 		 */
286 		if (!written || total)
287 			break;
288 		/* Nothing written and error, return error status. */
289 		total = written;
290 		break;
291 	}
292 	if (NDevSync(dev) && total && dops->sync(dev)) {
293 		total--; /* on sync error, return partially written */
294 	}
295 	ret = total;
296 out:
297 	return ret;
298 }
299 
300 /**
301  * ntfs_mst_pread - multi sector transfer (mst) positioned read
302  * @dev:	device to read from
303  * @pos:	position in file descriptor to read from
304  * @count:	number of blocks to read
305  * @bksize:	size of each block that needs mst deprotecting
306  * @b:		output data buffer
307  *
308  * Multi sector transfer (mst) positioned read. This function will read @count
309  * blocks of size @bksize bytes each from device @dev at position @pos into the
310  * the data buffer @b.
311  *
312  * On success, return the number of successfully read blocks. If this number is
313  * lower than @count this means that we have reached end of file, that the read
314  * was interrupted, or that an error was encountered during the read so that
315  * the read is partial. 0 means end of file or nothing was read (also return 0
316  * when @count or @bksize are 0).
317  *
318  * On error and nothing was read, return -1 with errno set appropriately to the
319  * return code of either seek, read, or set to EINVAL in case of invalid
320  * arguments.
321  *
322  * NOTE: If an incomplete multi sector transfer has been detected the magic
323  * will have been changed to magic_BAAD but no error will be returned. Thus it
324  * is possible that we return count blocks as being read but that any number
325  * (between zero and count!) of these blocks is actually subject to a multi
326  * sector transfer error. This should be detected by the caller by checking for
327  * the magic being "BAAD".
328  */
ntfs_mst_pread(struct ntfs_device * dev,const s64 pos,s64 count,const u32 bksize,void * b)329 s64 ntfs_mst_pread(struct ntfs_device *dev, const s64 pos, s64 count,
330 		const u32 bksize, void *b)
331 {
332 	s64 br, i;
333 
334 	if (bksize & (bksize - 1) || bksize % NTFS_BLOCK_SIZE) {
335 		errno = EINVAL;
336 		return -1;
337 	}
338 	/* Do the read. */
339 	br = ntfs_pread(dev, pos, count * bksize, b);
340 	if (br < 0)
341 		return br;
342 	/*
343 	 * Apply fixups to successfully read data, disregarding any errors
344 	 * returned from the MST fixup function. This is because we want to
345 	 * fixup everything possible and we rely on the fact that the "BAAD"
346 	 * magic will be detected later on.
347 	 */
348 	count = br / bksize;
349 	for (i = 0; i < count; ++i)
350 		ntfs_mst_post_read_fixup((NTFS_RECORD*)
351 				((u8*)b + i * bksize), bksize);
352 	/* Finally, return the number of complete blocks read. */
353 	return count;
354 }
355 
356 /**
357  * ntfs_mst_pwrite - multi sector transfer (mst) positioned write
358  * @dev:	device to write to
359  * @pos:	position in file descriptor to write to
360  * @count:	number of blocks to write
361  * @bksize:	size of each block that needs mst protecting
362  * @b:		data buffer to write to disk
363  *
364  * Multi sector transfer (mst) positioned write. This function will write
365  * @count blocks of size @bksize bytes each from data buffer @b to the device
366  * @dev at position @pos.
367  *
368  * On success, return the number of successfully written blocks. If this number
369  * is lower than @count this means that the write has been interrupted or that
370  * an error was encountered during the write so that the write is partial. 0
371  * means nothing was written (also return 0 when @count or @bksize are 0).
372  *
373  * On error and nothing has been written, return -1 with errno set
374  * appropriately to the return code of either seek, write, or set
375  * to EINVAL in case of invalid arguments.
376  *
377  * NOTE: We mst protect the data, write it, then mst deprotect it using a quick
378  * deprotect algorithm (no checking). This saves us from making a copy before
379  * the write and at the same time causes the usn to be incremented in the
380  * buffer. This conceptually fits in better with the idea that cached data is
381  * always deprotected and protection is performed when the data is actually
382  * going to hit the disk and the cache is immediately deprotected again
383  * simulating an mst read on the written data. This way cache coherency is
384  * achieved.
385  */
ntfs_mst_pwrite(struct ntfs_device * dev,const s64 pos,s64 count,const u32 bksize,void * b)386 s64 ntfs_mst_pwrite(struct ntfs_device *dev, const s64 pos, s64 count,
387 		const u32 bksize, void *b)
388 {
389 	s64 written, i;
390 
391 	if (count < 0 || bksize % NTFS_BLOCK_SIZE) {
392 		errno = EINVAL;
393 		return -1;
394 	}
395 	if (!count)
396 		return 0;
397 	/* Prepare data for writing. */
398 	for (i = 0; i < count; ++i) {
399 		int err;
400 
401 		err = ntfs_mst_pre_write_fixup((NTFS_RECORD*)
402 				((u8*)b + i * bksize), bksize);
403 		if (err < 0) {
404 			/* Abort write at this position. */
405 			if (!i)
406 				return err;
407 			count = i;
408 			break;
409 		}
410 	}
411 	/* Write the prepared data. */
412 	written = ntfs_pwrite(dev, pos, count * bksize, b);
413 	/* Quickly deprotect the data again. */
414 	for (i = 0; i < count; ++i)
415 		ntfs_mst_post_write_fixup((NTFS_RECORD*)((u8*)b + i * bksize));
416 	if (written <= 0)
417 		return written;
418 	/* Finally, return the number of complete blocks written. */
419 	return written / bksize;
420 }
421 
422 /**
423  * ntfs_cluster_read - read ntfs clusters
424  * @vol:	volume to read from
425  * @lcn:	starting logical cluster number
426  * @count:	number of clusters to read
427  * @b:		output data buffer
428  *
429  * Read @count ntfs clusters starting at logical cluster number @lcn from
430  * volume @vol into buffer @b. Return number of clusters read or -1 on error,
431  * with errno set to the error code.
432  */
ntfs_cluster_read(const ntfs_volume * vol,const s64 lcn,const s64 count,void * b)433 s64 ntfs_cluster_read(const ntfs_volume *vol, const s64 lcn, const s64 count,
434 		void *b)
435 {
436 	s64 br;
437 
438 	if (!vol || lcn < 0 || count < 0) {
439 		errno = EINVAL;
440 		return -1;
441 	}
442 	if (vol->nr_clusters < lcn + count) {
443 		errno = ESPIPE;
444 		ntfs_log_perror("Trying to read outside of volume "
445 				"(%lld < %lld)", (long long)vol->nr_clusters,
446 			        (long long)lcn + count);
447 		return -1;
448 	}
449 	br = ntfs_pread(vol->dev, lcn << vol->cluster_size_bits,
450 			count << vol->cluster_size_bits, b);
451 	if (br < 0) {
452 		ntfs_log_perror("Error reading cluster(s)");
453 		return br;
454 	}
455 	return br >> vol->cluster_size_bits;
456 }
457 
458 /**
459  * ntfs_cluster_write - write ntfs clusters
460  * @vol:	volume to write to
461  * @lcn:	starting logical cluster number
462  * @count:	number of clusters to write
463  * @b:		data buffer to write to disk
464  *
465  * Write @count ntfs clusters starting at logical cluster number @lcn from
466  * buffer @b to volume @vol. Return the number of clusters written or -1 on
467  * error, with errno set to the error code.
468  */
ntfs_cluster_write(const ntfs_volume * vol,const s64 lcn,const s64 count,const void * b)469 s64 ntfs_cluster_write(const ntfs_volume *vol, const s64 lcn,
470 		const s64 count, const void *b)
471 {
472 	s64 bw;
473 
474 	if (!vol || lcn < 0 || count < 0) {
475 		errno = EINVAL;
476 		return -1;
477 	}
478 	if (vol->nr_clusters < lcn + count) {
479 		errno = ESPIPE;
480 		ntfs_log_perror("Trying to write outside of volume "
481 				"(%lld < %lld)", (long long)vol->nr_clusters,
482 			        (long long)lcn + count);
483 		return -1;
484 	}
485 	if (!NVolReadOnly(vol))
486 		bw = ntfs_pwrite(vol->dev, lcn << vol->cluster_size_bits,
487 				count << vol->cluster_size_bits, b);
488 	else
489 		bw = count << vol->cluster_size_bits;
490 	if (bw < 0) {
491 		ntfs_log_perror("Error writing cluster(s)");
492 		return bw;
493 	}
494 	return bw >> vol->cluster_size_bits;
495 }
496 
497 /**
498  * ntfs_device_offset_valid - test if a device offset is valid
499  * @dev:	open device
500  * @ofs:	offset to test for validity
501  *
502  * Test if the offset @ofs is an existing location on the device described
503  * by the open device structure @dev.
504  *
505  * Return 0 if it is valid and -1 if it is not valid.
506  */
ntfs_device_offset_valid(struct ntfs_device * dev,s64 ofs)507 static int ntfs_device_offset_valid(struct ntfs_device *dev, s64 ofs)
508 {
509 	char ch;
510 
511 	if (dev->d_ops->seek(dev, ofs, SEEK_SET) >= 0 &&
512 			dev->d_ops->read(dev, &ch, 1) == 1)
513 		return 0;
514 	return -1;
515 }
516 
517 /**
518  * ntfs_device_size_get - return the size of a device in blocks
519  * @dev:	open device
520  * @block_size:	block size in bytes in which to return the result
521  *
522  * Return the number of @block_size sized blocks in the device described by the
523  * open device @dev.
524  *
525  * Adapted from e2fsutils-1.19, Copyright (C) 1995 Theodore Ts'o.
526  *
527  * On error return -1 with errno set to the error code.
528  */
ntfs_device_size_get(struct ntfs_device * dev,int block_size)529 s64 ntfs_device_size_get(struct ntfs_device *dev, int block_size)
530 {
531 	s64 high, low;
532 
533 	if (!dev || block_size <= 0 || (block_size - 1) & block_size) {
534 		errno = EINVAL;
535 		return -1;
536 	}
537 #ifdef BLKGETSIZE64
538 	{	u64 size;
539 
540 		if (dev->d_ops->ioctl(dev, BLKGETSIZE64, &size) >= 0) {
541 			ntfs_log_debug("BLKGETSIZE64 nr bytes = %llu (0x%llx)\n",
542 					(unsigned long long)size,
543 					(unsigned long long)size);
544 			return (s64)size / block_size;
545 		}
546 	}
547 #endif
548 #ifdef BLKGETSIZE
549 	{	unsigned long size;
550 
551 		if (dev->d_ops->ioctl(dev, BLKGETSIZE, &size) >= 0) {
552 			ntfs_log_debug("BLKGETSIZE nr 512 byte blocks = %lu (0x%lx)\n",
553 					size, size);
554 			return (s64)size * 512 / block_size;
555 		}
556 	}
557 #endif
558 #ifdef FDGETPRM
559 	{       struct floppy_struct this_floppy;
560 
561 		if (dev->d_ops->ioctl(dev, FDGETPRM, &this_floppy) >= 0) {
562 			ntfs_log_debug("FDGETPRM nr 512 byte blocks = %lu (0x%lx)\n",
563 					(unsigned long)this_floppy.size,
564 					(unsigned long)this_floppy.size);
565 			return (s64)this_floppy.size * 512 / block_size;
566 		}
567 	}
568 #endif
569 #ifdef DIOCGMEDIASIZE
570 	{
571 		/* FreeBSD */
572 		off_t size;
573 
574 		if (dev->d_ops->ioctl(dev, DIOCGMEDIASIZE, &size) >= 0) {
575 			ntfs_log_debug("DIOCGMEDIASIZE nr bytes = %llu (0x%llx)\n",
576 					(unsigned long long)size,
577 					(unsigned long long)size);
578 			return (s64)size / block_size;
579 		}
580 	}
581 #endif
582 #ifdef DKIOCGETBLOCKCOUNT
583 	{
584 		/* Mac OS X */
585 		uint64_t blocks;
586 		int sector_size;
587 
588 		sector_size = ntfs_device_sector_size_get(dev);
589 		if (sector_size >= 0 && dev->d_ops->ioctl(dev,
590 			DKIOCGETBLOCKCOUNT, &blocks) >= 0)
591 		{
592 			ntfs_log_debug("DKIOCGETBLOCKCOUNT nr blocks = %llu (0x%llx)\n",
593 				(unsigned long long) blocks,
594 				(unsigned long long) blocks);
595 			return blocks * sector_size / block_size;
596 		}
597 	}
598 #endif
599 	/*
600 	 * We couldn't figure it out by using a specialized ioctl,
601 	 * so do binary search to find the size of the device.
602 	 */
603 	low = 0LL;
604 	for (high = 1024LL; !ntfs_device_offset_valid(dev, high); high <<= 1)
605 		low = high;
606 	while (low < high - 1LL) {
607 		const s64 mid = (low + high) / 2;
608 
609 		if (!ntfs_device_offset_valid(dev, mid))
610 			low = mid;
611 		else
612 			high = mid;
613 	}
614 	dev->d_ops->seek(dev, 0LL, SEEK_SET);
615 	return (low + 1LL) / block_size;
616 }
617 
618 /**
619  * ntfs_device_partition_start_sector_get - get starting sector of a partition
620  * @dev:	open device
621  *
622  * On success, return the starting sector of the partition @dev in the parent
623  * block device of @dev.  On error return -1 with errno set to the error code.
624  *
625  * The following error codes are defined:
626  *	EINVAL		Input parameter error
627  *	EOPNOTSUPP	System does not support HDIO_GETGEO ioctl
628  *	ENOTTY		@dev is a file or a device not supporting HDIO_GETGEO
629  */
ntfs_device_partition_start_sector_get(struct ntfs_device * dev)630 s64 ntfs_device_partition_start_sector_get(struct ntfs_device *dev)
631 {
632 	if (!dev) {
633 		errno = EINVAL;
634 		return -1;
635 	}
636 #ifdef HDIO_GETGEO
637 	{	struct hd_geometry geo;
638 
639 		if (!dev->d_ops->ioctl(dev, HDIO_GETGEO, &geo)) {
640 			ntfs_log_debug("HDIO_GETGEO start_sect = %lu (0x%lx)\n",
641 					geo.start, geo.start);
642 			return geo.start;
643 		}
644 	}
645 #else
646 	errno = EOPNOTSUPP;
647 #endif
648 	return -1;
649 }
650 
ntfs_device_get_geo(struct ntfs_device * dev)651 static int ntfs_device_get_geo(struct ntfs_device *dev)
652 {
653 	int err;
654 
655 	if (!dev) {
656 		errno = EINVAL;
657 		return -1;
658 	}
659 	err = EOPNOTSUPP;
660 #ifdef ENABLE_HD
661 	{
662 		hd_data_t *hddata;
663 		hd_t *hd, *devlist, *partlist = NULL;
664 		str_list_t *names;
665 		hd_res_t *res;
666 		const int d_name_len = strlen(dev->d_name) + 1;
667 		int done = 0;
668 
669 		hddata = calloc(1, sizeof(*hddata));
670 		if (!hddata) {
671 			err = ENOMEM;
672 			goto skip_hd;
673 		}
674 		/* List all "disk" class devices on the system. */
675 		devlist = hd_list(hddata, hw_disk, 1, NULL);
676 		if (!devlist) {
677 			free(hddata);
678 			err = ENOMEM;
679 			goto skip_hd;
680 		}
681 		/*
682 		 * Loop over each disk device looking for the device with the
683 		 * same unix name as @dev.
684 		 */
685 		for (hd = devlist; hd; hd = hd->next) {
686 			if (hd->unix_dev_name && !strncmp(dev->d_name,
687 					hd->unix_dev_name, d_name_len))
688 				goto got_hd;
689 			if (hd->unix_dev_name2 && !strncmp(dev->d_name,
690 					hd->unix_dev_name2, d_name_len))
691 				goto got_hd;
692 			for (names = hd->unix_dev_names; names;
693 					names = names->next) {
694 				if (names->str && !strncmp(dev->d_name,
695 						names->str, d_name_len))
696 					goto got_hd;
697 			}
698 		}
699 		/*
700 		 * Device was not a whole disk device.  Unless it is a file it
701 		 * is likely to be a partition device.  List all "partition"
702 		 * class devices on the system.
703 		 */
704 		partlist = hd_list(hddata, hw_partition, 1, NULL);
705 		for (hd = partlist; hd; hd = hd->next) {
706 			if (hd->unix_dev_name && !strncmp(dev->d_name,
707 					hd->unix_dev_name, d_name_len))
708 				goto got_part_hd;
709 			if (hd->unix_dev_name2 && !strncmp(dev->d_name,
710 					hd->unix_dev_name2, d_name_len))
711 				goto got_part_hd;
712 			for (names = hd->unix_dev_names; names;
713 					names = names->next) {
714 				if (names->str && !strncmp(dev->d_name,
715 						names->str, d_name_len))
716 					goto got_part_hd;
717 			}
718 		}
719 		/* Failed to find the device.  Stop trying and clean up. */
720 		goto end_hd;
721 got_part_hd:
722 		/* Get the whole block device the partition device is on. */
723 		hd = hd_get_device_by_idx(hddata, hd->attached_to);
724 		if (!hd)
725 			goto end_hd;
726 got_hd:
727 		/*
728 		 * @hd is now the whole block device either being formatted or
729 		 * that the partition being formatted is on.
730 		 *
731 		 * Loop over each resource of the disk device looking for the
732 		 * BIOS legacy geometry obtained from EDD which is what Windows
733 		 * needs to boot.
734 		 */
735 		for (res = hd->res; res; res = res->next) {
736 			/* geotype 3 is BIOS legacy. */
737 			if (res->any.type != res_disk_geo ||
738 					res->disk_geo.geotype != 3)
739 				continue;
740 			dev->d_heads = res->disk_geo.heads;
741 			dev->d_sectors_per_track = res->disk_geo.sectors;
742 			done = 1;
743 		}
744 end_hd:
745 		if (partlist)
746 			hd_free_hd_list(partlist);
747 		hd_free_hd_list(devlist);
748 		hd_free_hd_data(hddata);
749 		free(hddata);
750 		if (done) {
751 			ntfs_log_debug("EDD/BIOD legacy heads = %u, sectors "
752 					"per track = %u\n", dev->d_heads,
753 					dev->d_sectors_per_track);
754 			return 0;
755 		}
756 	}
757 skip_hd:
758 #endif
759 #ifdef HDIO_GETGEO
760 	{	struct hd_geometry geo;
761 
762 		if (!dev->d_ops->ioctl(dev, HDIO_GETGEO, &geo)) {
763 			dev->d_heads = geo.heads;
764 			dev->d_sectors_per_track = geo.sectors;
765 			ntfs_log_debug("HDIO_GETGEO heads = %u, sectors per "
766 					"track = %u\n", dev->d_heads,
767 					dev->d_sectors_per_track);
768 			return 0;
769 		}
770 		err = errno;
771 	}
772 #endif
773 	errno = err;
774 	return -1;
775 }
776 
777 /**
778  * ntfs_device_heads_get - get number of heads of device
779  * @dev:		open device
780  *
781  * On success, return the number of heads on the device @dev.  On error return
782  * -1 with errno set to the error code.
783  *
784  * The following error codes are defined:
785  *	EINVAL		Input parameter error
786  *	EOPNOTSUPP	System does not support HDIO_GETGEO ioctl
787  *	ENOTTY		@dev is a file or a device not supporting HDIO_GETGEO
788  *	ENOMEM		Not enough memory to complete the request
789  */
ntfs_device_heads_get(struct ntfs_device * dev)790 int ntfs_device_heads_get(struct ntfs_device *dev)
791 {
792 	if (!dev) {
793 		errno = EINVAL;
794 		return -1;
795 	}
796 	if (dev->d_heads == -1) {
797 		if (ntfs_device_get_geo(dev) == -1)
798 			return -1;
799 		if (dev->d_heads == -1) {
800 			errno = EINVAL;
801 			return -1;
802 		}
803 	}
804 	return dev->d_heads;
805 }
806 
807 /**
808  * ntfs_device_sectors_per_track_get - get number of sectors per track of device
809  * @dev:		open device
810  *
811  * On success, return the number of sectors per track on the device @dev.  On
812  * error return -1 with errno set to the error code.
813  *
814  * The following error codes are defined:
815  *	EINVAL		Input parameter error
816  *	EOPNOTSUPP	System does not support HDIO_GETGEO ioctl
817  *	ENOTTY		@dev is a file or a device not supporting HDIO_GETGEO
818  *	ENOMEM		Not enough memory to complete the request
819  */
ntfs_device_sectors_per_track_get(struct ntfs_device * dev)820 int ntfs_device_sectors_per_track_get(struct ntfs_device *dev)
821 {
822 	if (!dev) {
823 		errno = EINVAL;
824 		return -1;
825 	}
826 	if (dev->d_sectors_per_track == -1) {
827 		if (ntfs_device_get_geo(dev) == -1)
828 			return -1;
829 		if (dev->d_sectors_per_track == -1) {
830 			errno = EINVAL;
831 			return -1;
832 		}
833 	}
834 	return dev->d_sectors_per_track;
835 }
836 
837 /**
838  * ntfs_device_sector_size_get - get sector size of a device
839  * @dev:	open device
840  *
841  * On success, return the sector size in bytes of the device @dev.
842  * On error return -1 with errno set to the error code.
843  *
844  * The following error codes are defined:
845  *	EINVAL		Input parameter error
846  *	EOPNOTSUPP	System does not support BLKSSZGET ioctl
847  *	ENOTTY		@dev is a file or a device not supporting BLKSSZGET
848  */
ntfs_device_sector_size_get(struct ntfs_device * dev)849 int ntfs_device_sector_size_get(struct ntfs_device *dev)
850 {
851 	if (!dev) {
852 		errno = EINVAL;
853 		return -1;
854 	}
855 #ifdef BLKSSZGET
856 	{
857 		int sect_size = 0;
858 
859 		if (!dev->d_ops->ioctl(dev, BLKSSZGET, &sect_size)) {
860 			ntfs_log_debug("BLKSSZGET sector size = %d bytes\n",
861 					sect_size);
862 			return sect_size;
863 		}
864 	}
865 #elif defined(DIOCGSECTORSIZE)
866 	{
867 		/* FreeBSD */
868 		size_t sect_size = 0;
869 
870 		if (!dev->d_ops->ioctl(dev, DIOCGSECTORSIZE, &sect_size)) {
871 			ntfs_log_debug("DIOCGSECTORSIZE sector size = %d bytes\n",
872 					(int) sect_size);
873 			return sect_size;
874 		}
875 	}
876 #elif defined(DKIOCGETBLOCKSIZE)
877 	{
878 		/* Mac OS X */
879 		uint32_t sect_size = 0;
880 
881 		if (!dev->d_ops->ioctl(dev, DKIOCGETBLOCKSIZE, &sect_size)) {
882 			ntfs_log_debug("DKIOCGETBLOCKSIZE sector size = %d bytes\n",
883 					(int) sect_size);
884 			return sect_size;
885 		}
886 	}
887 #else
888 	errno = EOPNOTSUPP;
889 #endif
890 	return -1;
891 }
892 
893 /**
894  * ntfs_device_block_size_set - set block size of a device
895  * @dev:	open device
896  * @block_size: block size to set @dev to
897  *
898  * On success, return 0.
899  * On error return -1 with errno set to the error code.
900  *
901  * The following error codes are defined:
902  *	EINVAL		Input parameter error
903  *	EOPNOTSUPP	System does not support BLKBSZSET ioctl
904  *	ENOTTY		@dev is a file or a device not supporting BLKBSZSET
905  */
ntfs_device_block_size_set(struct ntfs_device * dev,int block_size)906 int ntfs_device_block_size_set(struct ntfs_device *dev,
907 		int block_size __attribute__((unused)))
908 {
909 	if (!dev) {
910 		errno = EINVAL;
911 		return -1;
912 	}
913 #ifdef BLKBSZSET
914 	{
915 		size_t s_block_size = block_size;
916 		if (!dev->d_ops->ioctl(dev, BLKBSZSET, &s_block_size)) {
917 			ntfs_log_debug("Used BLKBSZSET to set block size to "
918 					"%d bytes.\n", block_size);
919 			return 0;
920 		}
921 		/* If not a block device, pretend it was successful. */
922 		if (!NDevBlock(dev))
923 			return 0;
924 	}
925 #else
926 	/* If not a block device, pretend it was successful. */
927 	if (!NDevBlock(dev))
928 		return 0;
929 	errno = EOPNOTSUPP;
930 #endif
931 	return -1;
932 }
933