Mirrors_Framework/stmbl
1
0
Fork 0
mirror of https://github.com/rene-dev/stmbl.git synced 2026-02-05 18:01:21 +08:00
Code Issues Actions Packages Projects Releases Wiki Activity

hx711

Browse Source
This commit is contained in:
crinq
2020-02-20 23:02:18 +01:00
parent b12dbe342c
commit 4fca5f20ed
1 changed files with 56 additions and 21 deletions
Download Patch File Download Diff File Expand all files Collapse all files

77
src/comps/hx711.c
View File

@@ -27,10 +27,14 @@
HAL_COMP(hx); HAL_COMP(hx);
HAL_PIN(out); HAL_PIN(out0);
HAL_PIN(out1);
HAL_PIN(gain); HAL_PIN(gain);
HAL_PIN(offset); HAL_PIN(offset);
HAL_PIN(sleep); HAL_PIN(sleep);
HAL_PIN(clk_inv);
HAL_PIN(data_inv);
HAL_PIN(timer);
struct hx_ctx_t { struct hx_ctx_t {
uint32_t error; uint32_t error;
@@ -73,33 +77,64 @@ static void hw_init(void *ctx_ptr, hal_pin_inst_t *pin_ptr) {
static void rt_func(float period, void *ctx_ptr, hal_pin_inst_t *pin_ptr) { static void rt_func(float period, void *ctx_ptr, hal_pin_inst_t *pin_ptr) {
//struct hx_ctx_t *ctx = (struct hx_ctx_t *)ctx_ptr; //struct hx_ctx_t *ctx = (struct hx_ctx_t *)ctx_ptr;
struct hx_pin_ctx_t *pins = (struct hx_pin_ctx_t *)pin_ptr; struct hx_pin_ctx_t *pins = (struct hx_pin_ctx_t *)pin_ptr;
uint32_t value = 0; uint32_t value0 = 0;
uint32_t value1 = 0;
int sleep = CLAMP(PIN(sleep), 1, 100); int sleep = CLAMP(PIN(sleep), 1, 100);
if(!GPIO_ReadInputDataBit(FB1_A_PORT, FB1_A_PIN)){//data line low = conversion ready if(PIN(timer) > 0.005){
for(int i = 0 ; i < 24;i++){ if((PIN(data_inv) > 0.0) ? (GPIO_ReadInputDataBit(FB1_A_PORT, FB1_A_PIN)) : (!GPIO_ReadInputDataBit(FB1_A_PORT, FB1_A_PIN))){//data line low = conversion ready
nopsleep(sleep); for(int i = 0 ; i < 24;i++){
GPIO_SetBits(FB1_Z_PORT, FB1_Z_PIN); if(PIN(clk_inv) > 0.0){
nopsleep(sleep); nopsleep(sleep);
GPIO_ResetBits(FB1_Z_PORT, FB1_Z_PIN); GPIO_ResetBits(FB1_Z_PORT, FB1_Z_PIN);
if(GPIO_ReadInputDataBit(FB1_A_PORT, FB1_A_PIN)){//dout = 1 nopsleep(sleep);
value++; GPIO_SetBits(FB1_Z_PORT, FB1_Z_PIN);
}
else{
nopsleep(sleep);
GPIO_SetBits(FB1_Z_PORT, FB1_Z_PIN);
nopsleep(sleep);
GPIO_ResetBits(FB1_Z_PORT, FB1_Z_PIN);
}
if((PIN(data_inv) > 0.0) ? (GPIO_ReadInputDataBit(FB1_A_PORT, FB1_A_PIN)) : (!GPIO_ReadInputDataBit(FB1_A_PORT, FB1_A_PIN))){//dout = 1
value0++;
}
value0 = value0 << 1;
if((PIN(data_inv) > 0.0) ? (GPIO_ReadInputDataBit(FB1_B_PORT, FB1_B_PIN)) : (!GPIO_ReadInputDataBit(FB1_B_PORT, FB1_B_PIN))){//dout = 1
value1++;
}
value1 = value1 << 1;
}
//clock additional config bits
if(PIN(clk_inv) > 0.0){
nopsleep(sleep);
GPIO_ResetBits(FB1_Z_PORT, FB1_Z_PIN);
nopsleep(sleep);
GPIO_SetBits(FB1_Z_PORT, FB1_Z_PIN);
}
else{
nopsleep(sleep);
GPIO_SetBits(FB1_Z_PORT, FB1_Z_PIN);
nopsleep(sleep);
GPIO_ResetBits(FB1_Z_PORT, FB1_Z_PIN);
} }
value = value << 1;
}
//clock additional config bits
nopsleep(sleep);
GPIO_SetBits(FB1_Z_PORT, FB1_Z_PIN);
nopsleep(sleep);
GPIO_ResetBits(FB1_Z_PORT, FB1_Z_PIN);
if(value & 0x800000){//if 24th bit is set, pad others, to get 2 complement number if(value0 & 0x800000){//if 24th bit is set, pad others, to get 2 complement number
value |= 0xff000000; value0 |= 0xff000000;
}
int32_t sint = *((int32_t*)(&value0));
PIN(out0) = ((float)sint/(float)0x7fffff)*PIN(gain)+PIN(offset);
if(value1 & 0x800000){//if 24th bit is set, pad others, to get 2 complement number
value1 |= 0xff000000;
}
sint = *((int32_t*)(&value1));
PIN(out1) = ((float)sint/(float)0x7fffff)*PIN(gain)+PIN(offset);
PIN(timer) = 0.0;
} }
int32_t sint = *((int32_t*)(&value));
PIN(out) = ((float)sint/(float)0x7fffff)*PIN(gain)+PIN(offset);
} }
PIN(timer) += period;
} }
hal_comp_t hx_comp_struct = { hal_comp_t hx_comp_struct = {