Function rt_floppy_read

bsp/x86/drivers/floppy.c:268–298

position: block page address, not bytes address * buffer: * size : how many blocks */

 * size  : how many blocks
 */
static rt_ssize_t rt_floppy_read(rt_device_t device, rt_off_t position, void *buffer, rt_size_t size)
{
    rt_size_t doSize = size;

    rt_mutex_take(&lock, RT_WAITING_FOREVER);
    while(size>0)
    {
        floppy_read_cmd(position);

        rt_sem_take(&sem, RT_WAITING_FOREVER); /* waiting isr sem forever */

        floppy_result();
        io_delay();

        if(ST1 != 0 || ST2 != 0)
        {
            panic("ST0 %d ST1 %d ST2 %d\n",ST0,ST1,ST2);
        }

        rt_memcpy(buffer, floppy_buffer, 512);

        floppy_motorOff();
        io_delay();

        position += 1;
        size     -= 1;
    }
    rt_mutex_release(&lock);

    return doSize;
}

/* position: block page address, not bytes address
 * buffer: