Home | History | Annotate | Line # | Download | only in common
floppy_2hd_ibmpc.c revision 1.1.28.1
      1  1.1.28.1     yamt /*	$NetBSD: floppy_2hd_ibmpc.c,v 1.1.28.1 2007/02/27 16:50:38 yamt Exp $	*/
      2       1.1  tsutsui 
      3       1.1  tsutsui /*-
      4       1.1  tsutsui  * Copyright (c) 2004 The NetBSD Foundation, Inc.
      5       1.1  tsutsui  * All rights reserved.
      6       1.1  tsutsui  *
      7       1.1  tsutsui  * This code is derived from software contributed to The NetBSD Foundation
      8       1.1  tsutsui  * by UCHIYAMA Yasushi.
      9       1.1  tsutsui  *
     10       1.1  tsutsui  * Redistribution and use in source and binary forms, with or without
     11       1.1  tsutsui  * modification, are permitted provided that the following conditions
     12       1.1  tsutsui  * are met:
     13       1.1  tsutsui  * 1. Redistributions of source code must retain the above copyright
     14       1.1  tsutsui  *    notice, this list of conditions and the following disclaimer.
     15       1.1  tsutsui  * 2. Redistributions in binary form must reproduce the above copyright
     16       1.1  tsutsui  *    notice, this list of conditions and the following disclaimer in the
     17       1.1  tsutsui  *    documentation and/or other materials provided with the distribution.
     18       1.1  tsutsui  * 3. All advertising materials mentioning features or use of this software
     19       1.1  tsutsui  *    must display the following acknowledgement:
     20       1.1  tsutsui  *        This product includes software developed by the NetBSD
     21       1.1  tsutsui  *        Foundation, Inc. and its contributors.
     22       1.1  tsutsui  * 4. Neither the name of The NetBSD Foundation nor the names of its
     23       1.1  tsutsui  *    contributors may be used to endorse or promote products derived
     24       1.1  tsutsui  *    from this software without specific prior written permission.
     25       1.1  tsutsui  *
     26       1.1  tsutsui  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     27       1.1  tsutsui  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     28       1.1  tsutsui  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     29       1.1  tsutsui  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     30       1.1  tsutsui  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     31       1.1  tsutsui  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     32       1.1  tsutsui  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     33       1.1  tsutsui  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     34       1.1  tsutsui  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     35       1.1  tsutsui  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     36       1.1  tsutsui  * POSSIBILITY OF SUCH DAMAGE.
     37       1.1  tsutsui  */
     38       1.1  tsutsui 
     39       1.1  tsutsui #include <sys/types.h>
     40       1.1  tsutsui #include "common.h"
     41       1.1  tsutsui 
     42  1.1.28.1     yamt bool
     43       1.1  tsutsui blk_to_2hd_position(uint32_t logical_block_number, uint32_t *position,
     44       1.1  tsutsui     int *count)
     45       1.1  tsutsui {
     46       1.1  tsutsui 	int sector, side, cylinder;
     47       1.1  tsutsui 
     48       1.1  tsutsui 	/*
     49       1.1  tsutsui 	 * 2HD: MFM format
     50       1.1  tsutsui 	 *	80 cylinders/disk
     51       1.1  tsutsui 	 *	 2 sides/disk
     52       1.1  tsutsui 	 *      18 sectors/track
     53       1.1  tsutsui 	 *     512 bytes/sector
     54       1.1  tsutsui 	 */
     55       1.1  tsutsui 	if (logical_block_number >= 2880)
     56  1.1.28.1     yamt 		return false;
     57       1.1  tsutsui 
     58       1.1  tsutsui 	cylinder = logical_block_number / (18 * 2);
     59       1.1  tsutsui 	side = logical_block_number - (cylinder * 18 * 2) > 17;
     60       1.1  tsutsui 	sector = logical_block_number - (side + cylinder * 2) * 18 + 1;
     61       1.1  tsutsui 
     62       1.1  tsutsui 	if (position)
     63       1.1  tsutsui 		*position = (cylinder << 16) | (side << 8) | sector;
     64       1.1  tsutsui 	if (count)
     65       1.1  tsutsui 		*count = 1;
     66       1.1  tsutsui 
     67  1.1.28.1     yamt 	return true;
     68       1.1  tsutsui }
     69