resources/pio.cpp

   1 /* Quarn OS
   2  *
   3  * Programmable Input/Output
   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 "pio.h"
  24 #include "services/timer.h"
  25 #include "manes/manec.h"
  26
  27 using namespace services;
  28 using namespace manes;
  29 using namespace resources;
  30
  31 void pio::send_packet(const buffer &data) {
  32         buf = data;
  33 }
  34
  35 void pio::set_speed(int v) {
  36         assert("pio: too high transmission speed", v > 1000);
  37
  38         if (v != 0)
  39                 speed = 1000 / v;
  40         else
  41                 speed = 0;
  42 }
  43
  44 void pio::set_dep(p<stream> _dep) {
  45         dep = _dep;
  46 }
  47
  48 void pio::send_data_next() {
  49         if (ptr >= buf.get_size()) {
  50                 ready = true;
  51                 if (!notice_user.null())
  52                         notice_user();
  53                 return;
  54         }
  55         dep->write(buffer::to_mem(buf[ptr++]));
  56
  57         tm->set_timer(speed, snd_dt_nxt);
  58 }
  59
  60 bool pio::start(bool wait, delegate<void> notice) {
  61         tm = manec::get()->get<timer>("/timer");
  62
  63         ready = false;
  64         if (speed != 0) {
  65                 ptr = 0;
  66                 snd_dt_nxt = delegate<void>::method(this,&pio::send_data_next);
  67                 send_data_next();
  68         } else {
  69                 for (int i = 0; i < buf.get_size(); i++)
  70                         dep->write(buffer::to_mem(buf[i]));
  71                 if (!notice.null())
  72                         notice();
  73                 return true;
  74         }
  75         if (!wait) return true;
  76
  77         while (!ready) __asm__("hlt");
  78         return true;
  79 }
  80
  81 void pio::register_type() {
  82         manes::manec::get()->register_type<pio>("pio", "virtual_bus");
  83 }
  84