94 lines
2.1 KiB
C
94 lines
2.1 KiB
C
//
|
|
// Author: Wolfgang Spraul
|
|
//
|
|
// This is free and unencumbered software released into the public domain.
|
|
// For details see the UNLICENSE file at the root of the source tree.
|
|
//
|
|
|
|
#include "model.h"
|
|
#include "bit.h"
|
|
#include "parts.h"
|
|
|
|
static uint8_t* get_first_minor(struct fpga_bits* bits, int row, int major)
|
|
{
|
|
int i, num_frames;
|
|
|
|
num_frames = 0;
|
|
for (i = 0; i < major; i++)
|
|
num_frames += get_major_minors(XC6SLX9, i);
|
|
return &bits->d[(row*FRAMES_PER_ROW + num_frames)*FRAME_SIZE];
|
|
}
|
|
|
|
static int get_bit(struct fpga_bits* bits,
|
|
int row, int major, int minor, int bit_i)
|
|
{
|
|
return get_framebit(get_first_minor(bits, row, major)
|
|
+ minor*FRAME_SIZE, bit_i);
|
|
}
|
|
|
|
static void set_bit(struct fpga_bits* bits,
|
|
int row, int major, int minor, int bit_i)
|
|
{
|
|
return set_framebit(get_first_minor(bits, row, major)
|
|
+ minor*FRAME_SIZE, bit_i);
|
|
}
|
|
|
|
static void clear_bit(struct fpga_bits* bits,
|
|
int row, int major, int minor, int bit_i)
|
|
{
|
|
return clear_framebit(get_first_minor(bits, row, major)
|
|
+ minor*FRAME_SIZE, bit_i);
|
|
}
|
|
|
|
struct bit_pos
|
|
{
|
|
int row;
|
|
int major;
|
|
int minor;
|
|
int bit_i;
|
|
};
|
|
|
|
static int get_bitp(struct fpga_bits* bits, struct bit_pos* pos)
|
|
{
|
|
return get_bit(bits, pos->row, pos->major, pos->minor, pos->bit_i);
|
|
}
|
|
|
|
static void set_bitp(struct fpga_bits* bits, struct bit_pos* pos)
|
|
{
|
|
set_bit(bits, pos->row, pos->major, pos->minor, pos->bit_i);
|
|
}
|
|
|
|
static void clear_bitp(struct fpga_bits* bits, struct bit_pos* pos)
|
|
{
|
|
clear_bit(bits, pos->row, pos->major, pos->minor, pos->bit_i);
|
|
}
|
|
|
|
static struct bit_pos s_default_bits[] = {
|
|
{ 0, 0, 3, 66 },
|
|
{ 0, 1, 23, 1034 },
|
|
{ 0, 1, 23, 1035 },
|
|
{ 0, 1, 23, 1039 },
|
|
{ 2, 0, 3, 66 }};
|
|
|
|
int extract_model(struct fpga_model* model, struct fpga_bits* bits)
|
|
{
|
|
int i, rc;
|
|
|
|
for (i = 0; i < sizeof(s_default_bits)/sizeof(s_default_bits[0]); i++) {
|
|
if (!get_bitp(bits, &s_default_bits[i]))
|
|
FAIL(EINVAL);
|
|
clear_bitp(bits, &s_default_bits[i]);
|
|
}
|
|
return 0;
|
|
fail:
|
|
return rc;
|
|
}
|
|
|
|
int write_model(struct fpga_bits* bits, struct fpga_model* model)
|
|
{
|
|
int i;
|
|
for (i = 0; i < sizeof(s_default_bits)/sizeof(s_default_bits[0]); i++)
|
|
set_bitp(bits, &s_default_bits[i]);
|
|
return 0;
|
|
}
|