apps/com/main.c

   1 /*
   2     meinOS - A unix-like x86 microkernel operating system
   3     Copyright (C) 2008  Janosch Gräf <janosch.graef@gmx.net>
   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 3 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, see <http://www.gnu.org/licenses/>.
  17 */
  18
  19 #include <sys/types.h>
  20 #include <stdint.h>
  21 #include <stdlib.h>
  22 #include <devfs.h>
  23 #include <stdio.h>
  24
  25 #include "com.h"
  26
  27 static void quit() {
  28   size_t i;
  29
  30   for (i=0;i<4;i++) {
  31     if (devices[i]!=NULL) {
  32       devfs_removedev(devices[i]->dev);
  33       free(devices[i]);
  34     }
  35   }
  36 }
  37
  38 static struct com_device *com_dev_find(devfs_dev_t *dev) {
  39   size_t i;
  40
  41   for (i=0;i<4;i++) {
  42     if (dev==devices[i]->dev) return devices[i];
  43   }
  44   return NULL;
  45 }
  46
  47 static ssize_t com_onread(devfs_dev_t *dev,void *buf,size_t count,off_t offset) {
  48   struct com_device *com_dev = com_dev_find(dev);
  49   if (dev!=NULL) return com_dev_recv(com_dev,buf,count);
  50   else return -1;
  51 }
  52
  53 static ssize_t com_onwrite(devfs_dev_t *dev,void *buf,size_t count,off_t offset) {
  54   struct com_device *com_dev = com_dev_find(dev);
  55   if (dev!=NULL) return com_dev_send(com_dev,buf,count);
  56   else return -1;
  57 }
  58
  59 int main() {
  60   uint16_t io_ports[] = {0x3F8,0x2F8,0x3E8,0x2E8};
  61   size_t i;
  62
  63   devfs_init();
  64   atexit(quit);
  65
  66   for (i=0;i<4;i++) {
  67     if (io_ports[i]!=0) {
  68       char devname[5];
  69       snprintf(devname,5,"com%d",i);
  70       devfs_dev_t *dev = devfs_createdev(devname);
  71       if (dev!=NULL) {
  72         devfs_onread(dev,com_onread);
  73         devfs_onwrite(dev,com_onwrite);
  74         devices[i] = malloc(sizeof(struct com_device));
  75         devices[i]->base = io_ports[i];
  76         devices[i]->dev = dev;
  77       }
  78       else devices[i] = NULL;
  79     }
  80     else devices[i] = NULL;
  81   }
  82
  83   devfs_mainloop();
  84
  85   return 0;
  86 }