Homec4science
Diffusion sbcp-uc (master) Browse

sbcp-uc/src/register.c
d679d64bd219master

Last Change
Raw File

register.c
View Options

#include <p33Fxxxx.h>
#include "register.h"
sbcp_reg_val _NEAR sbcp_reg_table[SBCP_REG_TABLE_SIZE];
sbcp_reg_ctrl_params _NEAR sbcp_reg_params[SBCP_REG_TABLE_SIZE];
void set_volatile_register(sbcp_reg_address address,
uint16_t value){
sbcp_reg_table[address].u = value;
}
void set_persistent_register(sbcp_reg_address address,
uint16_t value){
unsigned int in_eeprom = DataEERead(2 * address);
//test if EEPROM read successful
if(in_eeprom == 0xffff && GetaddrNotFound()){
//nothing written, set given default value
sbcp_reg_table[address].u = value;
DataEEWrite(2 * address,value);
SetaddrNotFound(0);
} else {
sbcp_reg_table[address].u = in_eeprom;
}
}
void sbcp_init_registers(sbcp_class klass,
sbcp_id id,
sbcp_fw_version version,
sbcp_init_device_registers_fptr device_specific_init){
unsigned int i;
for(i = 0 ; i < SBCP_REG_TABLE_SIZE; ++i){
sbcp_reg_table[i].i = 0;
sbcp_reg_params[i].flags = SBCP_REG_UNIMPLEMENTED;
sbcp_reg_params[i].callback = SBCP_REG_NO_CALLBACK;
}
DataEEInit();
dataEEFlags.val = 0;
sbcp_add_register_no_callback(SBCP_REG_FW,
version,
SBCP_REG_READABLE | SBCP_REG_PERSISTENT);
sbcp_add_register_no_callback(SBCP_REG_CLASS,
klass,
SBCP_REG_READABLE | SBCP_REG_PERSISTENT);
sbcp_add_register_no_callback(SBCP_REG_ID,
id,
SBCP_REG_READABLE | SBCP_REG_PERSISTENT);
if(device_specific_init != (void*)0){
(*device_specific_init)();
}
}
void sbcp_add_register(sbcp_reg_address address,
uint16_t value,
sbcp_reg_flags flags,
sbcp_reg_host_wr_callback clb){
if(address >= SBCP_REG_TABLE_SIZE){
return;
}
if(address < SBCP_SPECIFIC_REG_START){
return;
}
if(flags & SBCP_REG_PERSISTENT){
set_persistent_register(address,value);
} else {
set_volatile_register(address,value);
}
sbcp_reg_flags(address) = flags;
if(flags & SBCP_REG_WRITABLE) {
sbcp_reg_clbck(address) = clb;
} else {
sbcp_reg_clbck(address) = SBCP_REG_NO_CALLBACK;
}
}
void sbcp_add_register_no_callback(sbcp_reg_address address,
uint16_t value,
sbcp_reg_flags flags){
sbcp_add_register(address, value, flags , SBCP_REG_NO_CALLBACK);
}
c4science · Help