[134f1c4] | 1 | /* Lecture des disquettes Thomson sous MS-DOS
|
---|
| 2 | * Version 2.1
|
---|
| 3 | * Copyright (C) 2000-2003 Eric Botcazou
|
---|
| 4 | *
|
---|
| 5 | * This program is free software; you can redistribute it and/or modify
|
---|
| 6 | * it under the terms of the GNU General Public License as published by
|
---|
| 7 | * the Free Software Foundation; either version 2 of the License, or
|
---|
| 8 | * (at your option) any later version.
|
---|
| 9 | *
|
---|
| 10 | * This program is distributed in the hope that it will be useful,
|
---|
| 11 | * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
---|
| 12 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
---|
| 13 | * GNU General Public License for more details.
|
---|
| 14 | *
|
---|
| 15 | * You should have received a copy of the GNU General Public License
|
---|
| 16 | * along with this program; if not, write to the Free Software
|
---|
| 17 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
---|
| 18 | */
|
---|
| 19 |
|
---|
| 20 | /* Limitations:
|
---|
| 21 | * - les faces 1 des disquettes ne sont pas accessibles,
|
---|
| 22 | * - les disquettes simple densité (format FM) ne sont pas lisibles.
|
---|
| 23 | */
|
---|
| 24 |
|
---|
| 25 | #ifndef SCAN_DEPEND
|
---|
| 26 | #include <stdio.h>
|
---|
| 27 | #include <stddef.h>
|
---|
| 28 | #include <bios.h>
|
---|
| 29 | #include <dpmi.h>
|
---|
| 30 | #include <sys/movedata.h>
|
---|
| 31 | #endif
|
---|
| 32 |
|
---|
| 33 | #include "floppy.h"
|
---|
| 34 |
|
---|
| 35 |
|
---|
| 36 | #define DISK_RETRY 3
|
---|
| 37 |
|
---|
| 38 | struct floppy_cmd {
|
---|
| 39 | int cmd;
|
---|
| 40 | int head;
|
---|
| 41 | int track;
|
---|
| 42 | int sector;
|
---|
| 43 | int nsects;
|
---|
| 44 | void *buffer;
|
---|
| 45 | };
|
---|
| 46 |
|
---|
| 47 | static int drive_type[2];
|
---|
| 48 | static int dpt_addr = 0;
|
---|
| 49 |
|
---|
| 50 | #define DPT_SIZE 11
|
---|
| 51 |
|
---|
| 52 | static unsigned char pc_dpt[DPT_SIZE];
|
---|
| 53 |
|
---|
| 54 |
|
---|
| 55 |
|
---|
| 56 | /* SetDiskParameters:
|
---|
| 57 | * Initialise les paramètres disquette pour le format Thomson.
|
---|
| 58 | */
|
---|
| 59 | static void SetDiskParameters(int density)
|
---|
| 60 | {
|
---|
| 61 | unsigned char to_dpt[DPT_SIZE];
|
---|
| 62 |
|
---|
| 63 | if (!dpt_addr) {
|
---|
| 64 | /* on récupère le vecteur 0x1E du BIOS qui pointe sur la table
|
---|
| 65 | des paramètres de la disquette */
|
---|
| 66 | _dosmemgetl(0x1E*4, 1, &dpt_addr);
|
---|
| 67 |
|
---|
| 68 | /* on sauvegarde les paramètres originaux */
|
---|
| 69 | _dosmemgetb(dpt_addr, DPT_SIZE, pc_dpt);
|
---|
| 70 | }
|
---|
| 71 |
|
---|
| 72 | /* on fixe les nouveaux paramètres */
|
---|
| 73 | to_dpt[0x0]=0xDF; /* spec1 */
|
---|
| 74 | to_dpt[0x1]=0x02; /* spec2 */
|
---|
| 75 | to_dpt[0x2]=0x25; /* motor turn off delay */
|
---|
| 76 | to_dpt[0x3]=density - 1; /* sector size = 128*2^n */
|
---|
| 77 | to_dpt[0x4]=0x10; /* 16 sectors/track */
|
---|
| 78 | to_dpt[0x5]=0x1B; /* gap between sectors */
|
---|
| 79 | to_dpt[0x6]=(density == 1 ? 0x80 : 0xFF); /* data length */
|
---|
| 80 | to_dpt[0x7]=0x2C; /* gap when formatting */
|
---|
| 81 | to_dpt[0x8]=0xE5; /* filler byte */
|
---|
| 82 | to_dpt[0x9]=0x0F; /* head settle time */
|
---|
| 83 | to_dpt[0xA]=0x08; /* motor start time */
|
---|
| 84 | _dosmemputb(to_dpt, DPT_SIZE, dpt_addr);
|
---|
| 85 |
|
---|
| 86 | /* reset */
|
---|
| 87 | biosdisk(0, 0, 0, 0, 1, 0, NULL);
|
---|
| 88 | }
|
---|
| 89 |
|
---|
| 90 |
|
---|
| 91 |
|
---|
| 92 | /* ExecCommand:
|
---|
| 93 | * Exécute la commande spécifiée (via l'interruption 13h du BIOS).
|
---|
| 94 | */
|
---|
| 95 | static int ExecCommand(int drive, int density, struct floppy_cmd *fd_cmd)
|
---|
| 96 | {
|
---|
| 97 | int i;
|
---|
| 98 | int ret=0x10;
|
---|
| 99 |
|
---|
| 100 | SetDiskParameters(density);
|
---|
| 101 |
|
---|
| 102 | for (i=0; i<DISK_RETRY; i++) {
|
---|
| 103 | ret=biosdisk(fd_cmd->cmd, drive, fd_cmd->head, fd_cmd->track,
|
---|
| 104 | fd_cmd->sector, fd_cmd->nsects, fd_cmd->buffer);
|
---|
| 105 |
|
---|
| 106 | if (ret==0) /* commande OK? */
|
---|
| 107 | break;
|
---|
| 108 |
|
---|
| 109 | if ((i>1) && (ret==0x11)) { /* commande non OK mais corrigée par ctrl? */
|
---|
| 110 | ret=0;
|
---|
| 111 | break;
|
---|
| 112 | }
|
---|
| 113 |
|
---|
| 114 | /* reset du lecteur */
|
---|
| 115 | biosdisk(0, 0, 0, 0, 1, 0, NULL);
|
---|
| 116 | }
|
---|
| 117 |
|
---|
| 118 | switch (ret) {
|
---|
| 119 |
|
---|
| 120 | case 0x02: /* address mark not found */
|
---|
| 121 | return 0x04; /* erreur sur l'adresse */
|
---|
| 122 |
|
---|
| 123 | case 0x03: /* disk write-protected */
|
---|
| 124 | return 0x01; /* disk protégé en écriture */
|
---|
| 125 |
|
---|
| 126 | case 0x04: /* sector not found */
|
---|
| 127 | case 0x07: /* drive parameter activity failed */
|
---|
| 128 | case 0x10: /* data read (CRC or ECC) error */
|
---|
| 129 | case 0x0A: /* bad sector flag detected */
|
---|
| 130 | case 0x0B: /* bad track flag detected */
|
---|
| 131 | return 0x08; /* erreur sur les données */
|
---|
| 132 |
|
---|
| 133 | case 0x06: /* floppy disk removed */
|
---|
| 134 | case 0x80: /* disk timed out or failed to respond */
|
---|
| 135 | return 0x10; /* lecteur non prêt */
|
---|
| 136 |
|
---|
| 137 | default:
|
---|
| 138 | return 0; /* OK */
|
---|
| 139 | }
|
---|
| 140 | }
|
---|
| 141 |
|
---|
| 142 |
|
---|
| 143 |
|
---|
| 144 | /* FloppyReadSector:
|
---|
| 145 | * Lit le secteur spécifié sur la disquette.
|
---|
| 146 | */
|
---|
| 147 | int FloppyReadSector(int drive, int density, int track, int sector, int nsects, unsigned char data[])
|
---|
| 148 | {
|
---|
| 149 | struct floppy_cmd fd_cmd;
|
---|
| 150 |
|
---|
| 151 | fd_cmd.cmd = 2;
|
---|
| 152 | fd_cmd.head = drive%2;
|
---|
| 153 | fd_cmd.track = track;
|
---|
| 154 | fd_cmd.sector = sector;
|
---|
| 155 | fd_cmd.nsects = nsects;
|
---|
| 156 | fd_cmd.buffer = data;
|
---|
| 157 |
|
---|
| 158 | return ExecCommand(drive/2, density, &fd_cmd);
|
---|
| 159 | }
|
---|
| 160 |
|
---|
| 161 |
|
---|
| 162 |
|
---|
| 163 | /* FloppyWriteSector:
|
---|
| 164 | * Ecrit le secteur spécifié sur la disquette.
|
---|
| 165 | */
|
---|
| 166 | int FloppyWriteSector(int drive, int density, int track, int sector, int nsects, const unsigned char data[])
|
---|
| 167 | {
|
---|
| 168 | struct floppy_cmd fd_cmd;
|
---|
| 169 |
|
---|
| 170 | fd_cmd.cmd = 3;
|
---|
| 171 | fd_cmd.head = drive%2;
|
---|
| 172 | fd_cmd.track = track;
|
---|
| 173 | fd_cmd.sector = sector;
|
---|
| 174 | fd_cmd.nsects = nsects;
|
---|
| 175 | fd_cmd.buffer = (unsigned char *)data;
|
---|
| 176 |
|
---|
| 177 | return ExecCommand(drive/2, density, &fd_cmd);
|
---|
| 178 | }
|
---|
| 179 |
|
---|
| 180 |
|
---|
| 181 |
|
---|
| 182 | /* FloppyFormatTrack:
|
---|
| 183 | * Formate la piste en utilisant la table des headers spécifiée.
|
---|
| 184 | */
|
---|
| 185 | int FloppyFormatTrack(int drive, int density, int track, const unsigned char header_table[])
|
---|
| 186 | {
|
---|
| 187 | struct floppy_cmd fd_cmd;
|
---|
| 188 | int format_type = 0;
|
---|
| 189 |
|
---|
| 190 | /* sélection du format de formatage */
|
---|
| 191 | switch (drive_type[drive/2]) {
|
---|
| 192 |
|
---|
| 193 | case 1:
|
---|
| 194 | /* 320/360 kb in 360 kb drive */
|
---|
| 195 | format_type = 1;
|
---|
| 196 | break;
|
---|
| 197 |
|
---|
| 198 | case 2:
|
---|
| 199 | /* 320/360 kb in 1.2 Mb drive */
|
---|
| 200 | format_type = 2;
|
---|
| 201 | break;
|
---|
| 202 |
|
---|
| 203 | case 3:
|
---|
| 204 | case 4:
|
---|
| 205 | case 5:
|
---|
| 206 | case 6:
|
---|
| 207 | /* 720 kb in 720 kb/1.44 Mb/2.88 Mb drive */
|
---|
| 208 | format_type = 4;
|
---|
| 209 | break;
|
---|
| 210 | }
|
---|
| 211 |
|
---|
| 212 | biosdisk(23, drive/2, 0, 0, 1, format_type, NULL);
|
---|
| 213 |
|
---|
| 214 | fd_cmd.cmd = 5;
|
---|
| 215 | fd_cmd.head = drive%2;
|
---|
| 216 | fd_cmd.track = track;
|
---|
| 217 | fd_cmd.sector = 1;
|
---|
| 218 | fd_cmd.nsects = 16;
|
---|
| 219 | fd_cmd.buffer = (unsigned char *)header_table;
|
---|
| 220 |
|
---|
| 221 | return ExecCommand(drive/2, density, &fd_cmd);
|
---|
| 222 | }
|
---|
| 223 |
|
---|
| 224 |
|
---|
| 225 |
|
---|
| 226 | /* FloppyInit:
|
---|
| 227 | * Initialise le module de lecture de disquettes.
|
---|
| 228 | */
|
---|
| 229 | int FloppyInit(struct floppy_info *fi, int enable_write_support)
|
---|
| 230 | {
|
---|
| 231 | __dpmi_regs r;
|
---|
| 232 | int i, num_drives = 0;
|
---|
| 233 |
|
---|
| 234 | (void) enable_write_support;
|
---|
| 235 |
|
---|
| 236 | for (i=0; i<2; i++) {
|
---|
| 237 | /* get drive parameters (int 13h, function 08h) */
|
---|
| 238 | r.h.ah = 0x08;
|
---|
| 239 | r.h.dl = i;
|
---|
| 240 |
|
---|
| 241 | __dpmi_int(0x13, &r);
|
---|
| 242 |
|
---|
| 243 | if (r.x.flags&1) { /* CF set? */
|
---|
| 244 | drive_type[i] = 0;
|
---|
| 245 |
|
---|
| 246 | fi->drive_type[2*i] = 0;
|
---|
| 247 | fi->drive_type[2*i+1] = 0;
|
---|
| 248 | }
|
---|
| 249 | else {
|
---|
| 250 | if (r.h.bl > 6) {
|
---|
| 251 | drive_type[i] = 0;
|
---|
| 252 |
|
---|
| 253 | fi->drive_type[2*i] = 0;
|
---|
| 254 | fi->drive_type[2*i+1] = 0;
|
---|
| 255 | }
|
---|
| 256 | else {
|
---|
| 257 | drive_type[i] = r.h.bl;
|
---|
| 258 |
|
---|
| 259 | fi->drive_type[2*i] = r.h.bl;
|
---|
| 260 | fi->drive_type[2*i+1] = 0; /* face 1 unsupported */
|
---|
| 261 | }
|
---|
| 262 |
|
---|
| 263 | num_drives++;
|
---|
| 264 | }
|
---|
| 265 | }
|
---|
| 266 |
|
---|
| 267 | fi->num_drives = num_drives;
|
---|
| 268 | fi->fm_support = 0;
|
---|
| 269 | fi->write_support = 1;
|
---|
| 270 |
|
---|
| 271 | return num_drives;
|
---|
| 272 | }
|
---|
| 273 |
|
---|
| 274 |
|
---|
| 275 |
|
---|
| 276 | /* FloppyExit:
|
---|
| 277 | * Met au repos le module de lecture de disquettes.
|
---|
| 278 | */
|
---|
| 279 | void FloppyExit(void)
|
---|
| 280 | {
|
---|
| 281 | if (dpt_addr) {
|
---|
| 282 | /* restaure les paramètres originaux */
|
---|
| 283 | _dosmemputb(pc_dpt, DPT_SIZE, dpt_addr);
|
---|
| 284 |
|
---|
| 285 | /* reset */
|
---|
| 286 | biosdisk(0, 0, 0, 0, 1, 0, NULL);
|
---|
| 287 |
|
---|
| 288 | dpt_addr = 0;
|
---|
| 289 | }
|
---|
| 290 | }
|
---|
| 291 |
|
---|