resources/fdc.cpp

   1 /* Quarn OS
   2  *
   3  * FDC
   4  *
   5  * Copyright (C) 2008-2009 Pawel Dziepak
   6  *
   7  * This program is free software; you can redistribute it and/or modify
   8  * it under the terms of the GNU General Public License as published by
   9  * the Free Software Foundation; either version 2 of the License, or
  10  * (at your option) any later version.
  11  *
  12  * This program is distributed in the hope that it will be useful,
  13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  * GNU General Public License for more details.
  16  *
  17  * You should have received a copy of the GNU General Public License along
  18  * with this program; if not, write to the Free Software Foundation, Inc.,
  19  * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
  20  *
  21  */
  22
  23 #include "fdc.h"
  24 #include "manes/manec.h"
  25
  26 using namespace manes;
  27 using namespace resources;
  28
  29 fdc::fdc() : sector_size(512), sectors_per_track(18) {
  30         //set_access_control(new spinlock);
  31 }
  32
  33 void fdc::read_block(int address, int count, void *buffer) {
  34         //access_read();
  35
  36         /* LBA -> CHS */
  37         int head = (address / sectors_per_track) & 1;
  38         int cyl = (address / sectors_per_track) >> 1;
  39         int start = address % sectors_per_track + 1;
  40
  41         fdc_read_sector(buffer, head, cyl, start, start + count);
  42
  43         //release();
  44 }
  45
  46 void fdc::write_block(int address, int count, void *buffer){
  47         /* LBA -> CHS */
  48         int head = (address / sectors_per_track) & 1;
  49         int cyl = (address / sectors_per_track) >> 1;
  50         int start = address % sectors_per_track + 1;
  51
  52         fdc_write_sector(buffer, head, cyl, start, start + count);
  53 }
  54
  55 int fdc::get_granulity() {
  56         return sector_size;
  57 }
  58
  59 bool fdc::init_device(p<did> iadr) {
  60         isaaddr = *iadr.cast<isa_did>();
  61
  62         fdc_init();
  63
  64         inited = true;
  65
  66         return true;
  67 }
  68
  69 void fdc::register_type() {
  70         manec::get()->register_type<fdc>("fdc", "isa");
  71 }