Filamentstr/05_wickler
Archived
1
0
Fork 0
Code Issues 3 Pull Requests Releases Wiki Activity

zero sensor value when both buttons pressed

Browse Source
This commit is contained in:
Eggert Jung
2022-09-05 17:10:22 +02:00
parent 0b5dc619a6
commit c62792a864
3 changed files with 13 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

4
kraftsensor.c
View File

@@ -12,6 +12,8 @@
int32_t kraftsensor_value; int32_t kraftsensor_value;
uint8_t kraftsensor_valid; uint8_t kraftsensor_valid;
int32_t kraftsensor_zero_offset = 0/*197700*/;
void timer2_init() void timer2_init()
{ {
TCCR2A = (1<<WGM21); //TIMER0 SET-UP: CTC MODE TCCR2A = (1<<WGM21); //TIMER0 SET-UP: CTC MODE
@@ -45,7 +47,7 @@ void do_kraftsensor(){
//kraftsensor_value = tmp; //kraftsensor_value = tmp;
/* conversion magic to milliNewton */ /* conversion magic to milliNewton */
kraftsensor_value = ((tmp + 197700 /*539363*/)*9.81)/177.380; kraftsensor_value = (((tmp /* + 539363*/)*9.81)/177.380)+kraftsensor_zero_offset;
//if(abs(kraftsensor_read - old_value) > 10000){ //if(abs(kraftsensor_read - old_value) > 10000){
// if(abs(last_read - kraftsensor_read) > 10000){ // if(abs(last_read - kraftsensor_read) > 10000){

2
kraftsensor.h
View File

@@ -8,6 +8,8 @@
extern int32_t kraftsensor_value; extern int32_t kraftsensor_value;
extern uint8_t kraftsensor_valid; extern uint8_t kraftsensor_valid;
extern int32_t kraftsensor_zero_offset;
void timer2_init(); void timer2_init();
void kraftsensor_init(); void kraftsensor_init();
void do_kraftsensor(void); void do_kraftsensor(void);

8
taenzer.c
View File

@@ -68,12 +68,20 @@ void do_taenzer(){
#if PLC_MQTT_ENABLED #if PLC_MQTT_ENABLED
send_settings(); send_settings();
#endif #endif
if(taenzer_state.homed == 1 && read_Input(BTN_KRAFT_MINUS, LEVEL))
{
kraftsensor_zero_offset = -(kraftsensor_value-kraftsensor_zero_offset);
}
} }
if (read_Input(BTN_KRAFT_MINUS, RISING)) { if (read_Input(BTN_KRAFT_MINUS, RISING)) {
taenzer_state.force_setpoint -= 1000; taenzer_state.force_setpoint -= 1000;
#if PLC_MQTT_ENABLED #if PLC_MQTT_ENABLED
send_settings(); send_settings();
#endif #endif
if(taenzer_state.homed == 1 && read_Input(BTN_KRAFT_PLUS, LEVEL))
{
kraftsensor_zero_offset = -(kraftsensor_value-kraftsensor_zero_offset);
}
} }
if (read_Input(BTN_TAENZER_START, RISING)) { if (read_Input(BTN_TAENZER_START, RISING)) {
taenzer_state.active = 1; taenzer_state.active = 1;