source: rtems/cpukit/libblock/src/ramdisk-driver.c @ 1560d12

4.104.11
Last change on this file since 1560d12 was 1560d12, checked in by Thomas Doerfler <Thomas.Doerfler@…>, on Oct 16, 2009 at 8:44:51 AM

restructuring of ramdisk code

  • Property mode set to 100644
File size: 2.8 KB
Line 
1/**
2 * @file
3 *
4 * @ingroup rtems_ramdisk
5 *
6 * @brief RAM disk block device implementation.
7 */
8
9/*
10 * Copyright (C) 2001 OKTET Ltd., St.-Petersburg, Russia
11 * Author: Victor V. Vengerov <vvv@oktet.ru>
12 *
13 * @(#) $Id$
14 */
15
16#include <stdio.h>
17#include <stdlib.h>
18#include <errno.h>
19#include <string.h>
20#include <inttypes.h>
21
22#include <rtems.h>
23#include <rtems/ramdisk.h>
24
25static void
26rtems_ramdisk_printf (const ramdisk *rd, const char *format, ...)
27{
28  if (rd->trace)
29  {
30    va_list args;
31    va_start (args, format);
32    printf ("ramdisk:");
33    vprintf (format, args);
34    printf ("\n");
35  }
36}
37
38static int
39ramdisk_read(struct ramdisk *rd, rtems_blkdev_request *req)
40{
41    uint8_t *from = rd->area;
42    uint32_t   i;
43    rtems_blkdev_sg_buffer *sg;
44
45    rtems_ramdisk_printf (rd, "ramdisk read: start=%d, blocks=%d",
46                          req->bufs[0].block, req->bufnum);
47
48    for (i = 0, sg = req->bufs; i < req->bufnum; i++, sg++)
49    {
50        rtems_ramdisk_printf (rd, "ramdisk read: buf=%d block=%d length=%d off=%d addr=%p",
51                              i, sg->block, sg->length, sg->block * rd->block_size,
52                              from + (sg->block * rd->block_size));
53        memcpy(sg->buffer, from + (sg->block * rd->block_size), sg->length);
54    }
55    req->req_done(req->done_arg, RTEMS_SUCCESSFUL, 0);
56    return 0;
57}
58
59static int
60ramdisk_write(struct ramdisk *rd, rtems_blkdev_request *req)
61{
62    uint8_t *to = rd->area;
63    uint32_t   i;
64    rtems_blkdev_sg_buffer *sg;
65
66    rtems_ramdisk_printf (rd, "ramdisk write: start=%d, blocks=%d",
67                          req->bufs[0].block, req->bufnum);
68    for (i = 0, sg = req->bufs; i < req->bufnum; i++, sg++)
69    {
70        rtems_ramdisk_printf (rd, "ramdisk write: buf=%d block=%d length=%d off=%d addr=%p",
71                              i, sg->block, sg->length, sg->block * rd->block_size,
72                              to + (sg->block * rd->block_size));
73        memcpy(to + (sg->block * rd->block_size), sg->buffer, sg->length);
74    }
75    req->req_done(req->done_arg, RTEMS_SUCCESSFUL, 0);
76    return 0;
77}
78
79int
80ramdisk_ioctl(rtems_disk_device *dd, uint32_t req, void *argp)
81{
82    switch (req)
83    {
84        case RTEMS_BLKIO_REQUEST:
85        {
86            rtems_blkdev_request *r = argp;
87            struct ramdisk *rd = rtems_disk_driver_data(dd);
88
89            switch (r->req)
90            {
91                case RTEMS_BLKDEV_REQ_READ:
92                    return ramdisk_read(rd, r);
93
94                case RTEMS_BLKDEV_REQ_WRITE:
95                    return ramdisk_write(rd, r);
96
97                default:
98                    errno = EINVAL;
99                    return -1;
100            }
101            break;
102        }
103 
104        default:
105            return rtems_blkdev_ioctl (dd, req, argp);
106            break;
107    }
108
109    errno = EINVAL;
110    return -1;
111}
Note: See TracBrowser for help on using the repository browser.