flash.c

Go to the documentation of this file.

#include "user_config.h"

#include <stdint.h>
#include <stdarg.h>
#include <string.h>
#include <math.h>

#include "flash.h"

#define USE_CACHE
// Cached flash read on 32bit boundry
#ifdef USE_CACHE

// Cached address and data
uint32_t _addr = 0;
uint32_t _data;
uint8_t *p8 = (uint8_t *) &_data;
uint8_t read_flash8(uint8_t *p)
{
    uint8_t offset;
    uint32_t addr = (uint32_t)p;

    offset = 3 & addr;                            // byte offset
    addr &= ~3;                                   // align 4 byte address

    if(addr != _addr)
    {
        _addr = addr;
        _data = *(uint32_t *) _addr;
    }
    return(p8[offset]);
}


#else
uint8_t read_flash8(uint8_t *p)
{
    uint8_t offset;
    uint32_t data;
    uint32_t addr = (uint32_t)p;
    uint8_t *p8 = (uint8_t *) &data;

    offset = 3 & addr;                            // byte offset
    addr &= ~3;                                   // align 4 byte address
    data = *(uint32_t *) addr;
    return(p8[offset]);
}
#endif

void cpy_flash(uint8_t *src, uint8_t *dest, int size)
{
    int i;
    for(i=0;i<size;++i)
    {
        dest[i] = read_flash8((uint8_t *)src+i);
    }
}


uint16_t read_flash16(uint8_t *p)
{
    uint16_t tmp;
    cpy_flash(p,(uint8_t *)&tmp, 2);
    return(tmp);
}


uint32_t read_flash32(uint8_t *p)
{
    uint32_t tmp;
    cpy_flash(p,(uint8_t *) &tmp, 4);
    return(tmp);
}


uint64_t read_flash64(uint8_t *p)
{
    uint64_t tmp;
    cpy_flash(p,(uint8_t *) &tmp, 8);
    return(tmp);
}


uint32_t read_flash_ptr(uint8_t *p)
{
    uint32_t tmp;
    cpy_flash(p,(uint8_t *) &tmp, 4);
    return(tmp);
}


int bittestv(unsigned char *ptr, int off)
{
    int data;
    data = read_flash8(ptr + (off>>3));
    return( (data & (0x80 >> (off&7))) );
}


int bittestxy(unsigned char *ptr, int x, int y, int w, int h)
{
    int off;

    if(y < 0 || y > h)
    {
        return 0;
    }
    if(x < 0 || x > w)
    {
        return 0;
    }
    off = y * w + x;
    return(bittestv(ptr, off));
}