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
master
Eggert Jung 3 years ago
parent 0b5dc619a6
commit c62792a864
3 changed files with 13 additions and 1 deletions
Show Stats Download Patch File Download Diff File

4
kraftsensor.c
Unescape Escape View File

@ -12,6 +12,8 @@
int32_t kraftsensor_value;
uint8_t kraftsensor_valid;
int32_t kraftsensor_zero_offset = 0/*197700*/;
void timer2_init()
{
TCCR2A = (1<<WGM21); //TIMER0 SET-UP: CTC MODE
@ -45,7 +47,7 @@ void do_kraftsensor(){
//kraftsensor_value = tmp;
/* 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(last_read - kraftsensor_read) > 10000){

2
kraftsensor.h
Unescape Escape View File

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

8
taenzer.c
Unescape Escape View File

@ -68,12 +68,20 @@ void do_taenzer(){
#if PLC_MQTT_ENABLED
send_settings();
#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)) {
taenzer_state.force_setpoint -= 1000;
#if PLC_MQTT_ENABLED
send_settings();
#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)) {
taenzer_state.active = 1;