7f8f0f50ea
Ref #1987 Fix #2058
126 lines
3.3 KiB
C++
126 lines
3.3 KiB
C++
/*
|
|
* \brief Test for the block session server side
|
|
* \author Stefan Kalkowski
|
|
* \date 2010-07-06
|
|
*
|
|
* This test app provides the framebuffer it requests via framebuffer session
|
|
* as a block device.
|
|
*/
|
|
|
|
/*
|
|
* Copyright (C) 2010-2013 Genode Labs GmbH
|
|
*
|
|
* This file is part of the Genode OS framework, which is distributed
|
|
* under the terms of the GNU General Public License version 2.
|
|
*/
|
|
|
|
#include <base/printf.h>
|
|
#include <framebuffer_session/connection.h>
|
|
#include <block/component.h>
|
|
|
|
class Driver : public Block::Driver
|
|
{
|
|
private:
|
|
|
|
enum { BLOCK_SIZE = 512 };
|
|
|
|
Framebuffer::Connection _fb;
|
|
Framebuffer::Mode _fb_mode;
|
|
Genode::Dataspace_capability _fb_cap;
|
|
Genode::Dataspace_client _fb_dsc;
|
|
Genode::addr_t _fb_addr;
|
|
Genode::size_t _fb_size;
|
|
|
|
public:
|
|
|
|
Driver()
|
|
: _fb_mode(_fb.mode()),
|
|
_fb_cap(_fb.dataspace()),
|
|
_fb_dsc(_fb_cap),
|
|
_fb_addr(Genode::env()->rm_session()->attach(_fb_cap)),
|
|
_fb_size(_fb_dsc.size()){}
|
|
|
|
|
|
/*******************************
|
|
** Block::Driver interface **
|
|
*******************************/
|
|
|
|
Genode::size_t block_size() { return BLOCK_SIZE; }
|
|
Block::sector_t block_count() { return _fb_size / BLOCK_SIZE; }
|
|
|
|
Block::Session::Operations ops()
|
|
{
|
|
Block::Session::Operations ops;
|
|
ops.set_operation(Block::Packet_descriptor::READ);
|
|
ops.set_operation(Block::Packet_descriptor::WRITE);
|
|
return ops;
|
|
}
|
|
|
|
void read(Block::sector_t block_number,
|
|
Genode::size_t block_count,
|
|
char *buffer,
|
|
Block::Packet_descriptor &packet)
|
|
{
|
|
/* sanity check block number */
|
|
if (block_number + block_count > _fb_size / BLOCK_SIZE) {
|
|
PWRN("Out of range: requested %zd blocks from block %llu",
|
|
block_count, block_number);
|
|
return;
|
|
}
|
|
|
|
Genode::size_t offset = block_number * BLOCK_SIZE;
|
|
Genode::size_t size = block_count * BLOCK_SIZE;
|
|
|
|
Genode::memcpy((void*)buffer, (void*)(_fb_addr + offset), size);
|
|
ack_packet(packet);
|
|
}
|
|
|
|
void write(Block::sector_t block_number,
|
|
Genode::size_t block_count,
|
|
char const *buffer,
|
|
Block::Packet_descriptor &packet)
|
|
{
|
|
/* sanity check block number */
|
|
if (block_number + block_count > _fb_size / BLOCK_SIZE) {
|
|
PWRN("Out of range: requested %zd blocks from block %llu",
|
|
block_count, block_number);
|
|
return;
|
|
}
|
|
|
|
Genode::size_t offset = block_number * BLOCK_SIZE;
|
|
Genode::size_t size = block_count * BLOCK_SIZE;
|
|
|
|
Genode::memcpy((void*)(_fb_addr + offset), (void*)buffer, size);
|
|
_fb.refresh(0, 0, _fb_mode.width(), _fb_mode.height());
|
|
ack_packet(packet);
|
|
}
|
|
};
|
|
|
|
|
|
struct Factory : Block::Driver_factory
|
|
{
|
|
Genode::Heap &heap;
|
|
|
|
Factory(Genode::Heap &heap) : heap(heap) {}
|
|
|
|
Block::Driver *create() { return new (&heap) Driver(); }
|
|
|
|
void destroy(Block::Driver *driver) { Genode::destroy(&heap, driver); }
|
|
};
|
|
|
|
|
|
struct Main
|
|
{
|
|
Genode::Env &env;
|
|
Genode::Heap heap { env.ram(), env.rm() };
|
|
struct Factory factory { heap };
|
|
Block::Root root { env.ep(), heap, factory };
|
|
|
|
Main(Genode::Env &env) : env(env) {
|
|
env.parent().announce(env.ep().manage(root)); }
|
|
};
|
|
|
|
|
|
Genode::size_t Component::stack_size() { return 2*1024*sizeof(long); }
|
|
void Component::construct(Genode::Env &env) { static Main m(env); }
|