1
/* (c) Gustav Hartvigsson 2020
5
0) You is granted to copy, redistrubute, modify, redistrubute
6
modified copies of the software, in any shape or form.
7
1) You are not obligated to give credit the original author(s) of
8
the sofware, but it would be cool of you if you did.
9
2) You are allowed to removed the copyright notice if you want to,
10
it is up to you, but it would be cool if you did not.
15
private static GLib.Tree<string, Type?> list_of_types;
17
private static GLib.Tree<FieldInfo?, uint16> mask_cache;
20
list_of_types = new GLib.Tree<string, Type?> ((a, b) => {
21
return (GLib.strcmp (a,b));
24
mask_cache = new GLib.Tree<FieldInfo?, uint16> ((a, b) => {
29
public void deinit () {
30
list_of_types.foreach ((_key, _val) => {
31
list_of_types.remove (_key);
36
public static bool add_type_v (string name, FieldInfo first_field, ...) {
39
GLib.List<FieldInfo?> lst = new GLib.List<FieldInfo?> ();
41
lst.append (first_field);
42
for (FieldInfo? fi = va.arg<FieldInfo> (); fi != null;
43
fi = va.arg<FieldInfo> ()) {
47
FieldInfo[] lst2 = new FieldInfo[lst.length ()];
49
for (uint i = 0; i < lst.length (); i++) {
50
lst2[i] = lst.nth_data (i);
53
return add_type (name, lst2);
57
* @Return true on error.
59
public bool add_type (string name, FieldInfo[] fields) {
60
GLib.List<FieldInfo?> lst = new GLib.List<FieldInfo?> ();
62
foreach (FieldInfo fi in fields) {
66
if (lst.length () >= 16) {
70
lst.sort ((a,b) => {return a.compare (b);});
73
for (uint8 i = 0; i < lst.length (); i++) {
74
var a = lst.nth_data (i);
75
// We valitade the items whilst we are at it.
77
GLib.critical ("Validtion of FieldInfo object failed: (%s)",
81
for (uint8 j = i + 1; i < lst.length (); j++) {
82
var b = lst.nth_data (j);
87
GLib.critical ("Overlappinng fields in \"%s\": (%s) (%s).\n" +
88
"\t Will not add bitmap type defitions.",
98
for (uint8 i = 0; i < lst.length (); i++) {
99
t.fields[i] = lst.nth_data (i);
102
list_of_types.insert (name, t);
104
// add the masks to the mask cach, so we don't have to re-calculate them
105
// each time we need them.
106
lst.foreach ((ii) => {
107
mask_cache.insert (ii, ii.generate_mask ());
114
public void set (ref uint16 data,
119
var tt = list_of_types.lookup (type_name);
121
GLib.critical ("Name \"%s\" dose not exist among the types valid types.",
125
var fi = tt.get_field_info (field_id);
126
uint16 mask = mask_cache.lookup (fi);
127
uint16 invert_mask = ~mask;
128
uint16 tmp = data & invert_mask; // everything exept the field.
131
for (uint8 i = 0; i < fi.length; i++) {
136
uint16 tmp2 = in_data & tmp_mask;
139
uint16 distance = 15 - fi.end;
142
tmp2 = tmp2 << distance;
150
public uint16 get (uint16 data,
154
var fi = list_of_types.lookup (type_name).get_field_info (field_id);
155
uint16 mask = mask_cache.lookup (fi);
156
uint16 tmp = data & mask; // only what is in the field.
159
uint16 distance = 15 - fi.end;
162
tmp = tmp >> distance;
166
Type? get_type (string name) {
167
return list_of_types.lookup (name);
171
* Create a new FieldInfo using the following syntax:
173
* enum MyTypeFields {
179
* BitField.FieldInfo[] my_fields_info = {
180
* BitField.FieldInfo (MyTypeFields.F1, 0, 5, 6),
181
* BitField.FieldInfo (MyTypeFields.F2, 0, 5, 6),
185
* if (FieldInfo.add_type ("MyType", my_fields_info)) {
186
* stderr.printf ("Something went wrong!");
191
[CCode (cprefix="bit_field_info_", cname="BitFieldInfo")]
192
public struct FieldInfo {
198
public FieldInfo (int field_id, uint8 start, uint8 end, uint8 length) {
199
this.field_id = field_id;
202
this.length = length;
205
public int compare (FieldInfo other) {
206
if (this.field_id != other.field_id) {
207
return this.field_id - other.field_id;
208
} else if (this.start != other.start) {
209
return this.start - other.start;
210
} else if (this.end != other.end) {
211
return this.end - other.end;
212
} else if (this.length != other.length) {
213
return this.length - other.length;
219
[CCode (cname = "bit_field_info_compare")]
220
public static extern int static_compare (FieldInfo a, FieldInfo b);
224
public bool overlap (FieldInfo other) {
225
return (!((this.start < other.end) || (this.end > other.start)));
228
[CCode (cname = "bit_field_info_overlap")]
229
public static extern bool static_overlap (FieldInfo a, FieldInfo b);
232
public string to_string () {
233
return "field_id: %i start: %i, end: %i, length: %i".printf (
241
* returns true on error;
243
public bool validate () {
244
var distance = this.end - this.start + 1;
245
if (distance < 1 || distance != this.length) {
251
[CCode (cname = "bit_field_info_validate")]
252
public extern static bool static_validate (FieldInfo info);
254
public uint16 generate_mask () {
256
for (size_t i = 0; i < this.length; i++) {
257
mask >>= 1; // shit it over to the right one.
258
mask += 0x8000; // set the left-most bit in the field
261
// Shift over the mask to where it should start.
267
[CCode (cname = "bit_field_info_generate_mask")]
268
public extern static uint16 static_generate_mask (FieldInfo info);
275
fields = new FieldInfo[16];
276
for (uint8 i = 0; i < 16; i++) {
277
fields[i] = {255,255,255,255};
281
public string to_string () {
282
var sb = new GLib.StringBuilder ();
284
sb.append (typeof (Type).name ())
286
for (size_t i = 0; i < fields.length; i++) {
288
.append (fields[i].to_string ())
296
public FieldInfo get_field_info (int field_id) {
300
foreach (FieldInfo ij in fields) {
301
if (ij.field_id == field_id) {