1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133
|
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "readers.h"
/* ----------------------------------------------------------------------- */
void load_bits_lsb(unsigned char *dst, unsigned char *src, int width,
int on, int off)
{
int i,mask,bit;
for (i = 0; i < width; i++) {
mask = 1 << (i & 0x07);
bit = src[i>>3] & mask;
dst[0] = bit ? on : off;
dst[1] = bit ? on : off;
dst[2] = bit ? on : off;
dst += 3;
}
}
void load_bits_msb(unsigned char *dst, unsigned char *src, int width,
int on, int off)
{
int i,mask,bit;
for (i = 0; i < width; i++) {
mask = 1 << (7 - (i & 0x07));
bit = src[i>>3] & mask;
dst[0] = bit ? on : off;
dst[1] = bit ? on : off;
dst[2] = bit ? on : off;
dst += 3;
}
}
void load_gray(unsigned char *dst, unsigned char *src, int width)
{
int i;
for (i = 0; i < width; i++) {
dst[0] = src[0];
dst[1] = src[0];
dst[2] = src[0];
dst += 3;
src += 1;
}
}
void load_graya(unsigned char *dst, unsigned char *src, int width)
{
int i;
for (i = 0; i < width; i++) {
dst[0] = src[0];
dst[1] = src[0];
dst[2] = src[0];
dst += 3;
src += 2;
}
}
void load_rgba(unsigned char *dst, unsigned char *src, int width)
{
int i;
for (i = 0; i < width; i++) {
dst[0] = src[0];
dst[1] = src[1];
dst[2] = src[2];
dst += 3;
src += 4;
}
}
/* ----------------------------------------------------------------------- */
int load_add_extra(struct ida_image_info *info, enum ida_extype type,
unsigned char *data, unsigned int size)
{
struct ida_extra *extra;
extra = malloc(sizeof(*extra));
if (NULL == extra)
return -1;
memset(extra,0,sizeof(*extra));
extra->data = malloc(size);
if (NULL == extra->data) {
free(extra);
return -1;
}
extra->type = type;
extra->size = size;
memcpy(extra->data,data,size);
extra->next = info->extra;
info->extra = extra;
return 0;
};
struct ida_extra* load_find_extra(struct ida_image_info *info,
enum ida_extype type)
{
struct ida_extra *extra;
for (extra = info->extra; NULL != extra; extra = extra->next)
if (type == extra->type)
return extra;
return NULL;
}
int load_free_extras(struct ida_image_info *info)
{
struct ida_extra *next;
while (NULL != info->extra) {
next = info->extra->next;
free(info->extra->data);
free(info->extra);
info->extra = next;
}
return 0;
}
/* ----------------------------------------------------------------------- */
LIST_HEAD(loaders);
void load_register(struct ida_loader *loader)
{
list_add_tail(&loader->list, &loaders);
}
|