88 lines
1.7 KiB
C++
88 lines
1.7 KiB
C++
|
|
#define CAT2(A,B) A ## B
|
|
#define CAT(A,B) CAT2(A, B)
|
|
#define UINT_T CAT(CAT(uint, SZ), _t)
|
|
#define FLIP CAT(capn_flip, SZ)
|
|
|
|
int CAT(capn_read,SZ) (const struct CAT(capn_list,SZ) *list, int off, UINT_T *to, int sz) {
|
|
int i;
|
|
const struct capn_ptr *p = &list->p;
|
|
|
|
if (off + sz > p->size) {
|
|
sz = p->size - off;
|
|
}
|
|
|
|
switch (p->type) {
|
|
case CAPN_LIST:
|
|
if (p->datasz == SZ/8 && !p->ptrsz && (SZ == 8 || CAPN_LITTLE)) {
|
|
memcpy(to, p->data + off, sz * (SZ/8));
|
|
return sz;
|
|
} else if (p->datasz < SZ/8) {
|
|
return -1;
|
|
}
|
|
|
|
for (i = 0; i < sz; i++) {
|
|
char *d = p->data + (i + off) * (p->datasz + p->ptrsz);
|
|
to[i] = FLIP(*(UINT_T*)d);
|
|
}
|
|
return sz;
|
|
|
|
case CAPN_PTR_LIST:
|
|
for (i = 0; i < sz; i++) {
|
|
char *d = struct_ptr(p->seg, p->data + 8*(i+off));
|
|
if (d) {
|
|
to[i] = FLIP(*(UINT_T*)d);
|
|
} else {
|
|
return -1;
|
|
}
|
|
}
|
|
return sz;
|
|
|
|
default:
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
int CAT(capn_write,SZ) (struct CAT(capn_list,SZ) *list, int off, const UINT_T *from, int sz) {
|
|
int i;
|
|
struct capn_ptr *p = &list->p;
|
|
|
|
if (off + sz > p->size) {
|
|
sz = p->size - off;
|
|
}
|
|
|
|
switch (p->type) {
|
|
case CAPN_LIST:
|
|
if (p->datasz == SZ/8 && !p->ptrsz && (SZ == 8 || CAPN_LITTLE)) {
|
|
memcpy(p->data + off, from, sz * (SZ/8));
|
|
return sz;
|
|
} else if (p->datasz < SZ/8) {
|
|
return -1;
|
|
}
|
|
|
|
for (i = 0; i < sz; i++) {
|
|
char *d = p->data + (i + off) * (p->datasz + p->ptrsz);
|
|
*(UINT_T*) d = FLIP(from[i]);
|
|
}
|
|
return sz;
|
|
|
|
case CAPN_PTR_LIST:
|
|
for (i = 0; i < sz; i++) {
|
|
char *d = struct_ptr(p->seg, p->data + 8*(i+off));
|
|
if (d) {
|
|
*(UINT_T*) d = FLIP(from[i]);
|
|
} else {
|
|
return -1;
|
|
}
|
|
}
|
|
return sz;
|
|
|
|
default:
|
|
return -1;
|
|
}
|
|
}
|
|
|
|
#undef FLIP
|
|
#undef UINT_T
|
|
#undef CAT
|
|
|