j/cable-length-cutter
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Add basic LAMP functionality; Fix comments

Browse Source 
- Basic lamp functionality: simply turn on when not in COUNTING or TARGET_REACHED
    state

- Remove unnecessary comments, fix code formatting in several files
This commit is contained in:
jonny_ji7 2022-09-22 11:23:48 +02:00
parent 2cf1762569
commit 5b49406cb8
5 changed files with 49 additions and 54 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
function-diagram.drawio
View File

File diff suppressed because one or more lines are too long

46
main/control.cpp
View File

@ -24,7 +24,6 @@ QueueHandle_t init_encoder(rotary_encoder_info_t * info){
//====================
//==== variables =====
//====================
@ -75,6 +74,7 @@ void changeState (systemState_t stateNew) {
}
//===== handle Stop Condition =====
//function that checks whether start button is released or target is reached (used in multiple states)
//returns true when stopped, false when no action
@ -182,15 +182,12 @@ void task_control(void *pvParameter)
// Poll current position and direction
rotary_encoder_get_state(&encoder, &encoderState);
//--- calculate distance ---
//lengthNow = (float)encoderState.position * (MEASURING_ROLL_DIAMETER * PI) / 600; //TODO dont calculate constant factor every time FIXME: ROUNDING ISSUE float-int?
lengthNow = (float)encoderState.position * 1000 / STEPS_PER_METER;
//---------------------------
//--------- buttons ---------
//---------------------------
//TODO: ADD PRESET SWITCHES HERE
//--- RESET switch ---
if (SW_RESET.risingEdge) {
rotary_encoder_reset(&encoder);
@ -200,7 +197,6 @@ void task_control(void *pvParameter)
//cutter_stop();
}
//--- CUT switch ---
//start cut cycle immediately
if (SW_CUT.risingEdge) {
@ -217,11 +213,10 @@ void task_control(void *pvParameter)
}
//error cant cut while motor is on
else {
buzzer.beep(6, 70, 50);
buzzer.beep(6, 100, 50);
}
}
//--- AUTO_CUT toggle sw ---
//beep at change
if (SW_AUTO_CUT.risingEdge) {
@ -241,7 +236,6 @@ void task_control(void *pvParameter)
autoCutEnabled = false;
}
//--- manual mode ---
//switch to manual motor control (2 buttons + poti)
if ( SW_PRESET2.state && (SW_PRESET1.state || SW_PRESET3.state) && controlState != systemState_t::MANUAL ) {
@ -250,7 +244,6 @@ void task_control(void *pvParameter)
buzzer.beep(3, 100, 60);
}
//--- set custom target length ---
//set target length to poti position when SET switch is pressed
if (SW_SET.state == true) {
@ -318,11 +311,10 @@ void task_control(void *pvParameter)
switch (controlState) {
case systemState_t::COUNTING: //no motor action
vfd_setState(false);
//TODO check stop condition before starting - prevents motor from starting 2 cycles when
//TODO check stop condition before starting - prevents motor from starting 2 cycles when already at target
//--- start winding to length ---
if (SW_START.risingEdge) {
changeState(systemState_t::WINDING_START);
//TODO apply dynamic speed here too (if started when already very close)
vfd_setSpeedLevel(1); //start at low speed
vfd_setState(true); //start motor
timestamp_motorStarted = esp_log_timestamp(); //save time started
@ -360,9 +352,9 @@ void task_control(void *pvParameter)
}
//show msg when trying to start, but target is reached
if (SW_START.risingEdge) {
buzzer.beep(3, 40, 30);
displayTop.blink(2, 600, 800, " S0LL ");
displayBot.blink(2, 600, 800, "ERREICHT");
buzzer.beep(2, 50, 30);
displayTop.blink(2, 600, 500, " S0LL ");
displayBot.blink(2, 600, 500, "ERREICHT");
}
break;
@ -411,14 +403,14 @@ void task_control(void *pvParameter)
}
//P2 + P1 -> turn left
else if ( SW_PRESET1.state && !SW_PRESET3.state ) {
vfd_setSpeedLevel(level); //TODO: use poti input for level
vfd_setSpeedLevel(level);
vfd_setState(true, REV);
sprintf(buf_disp2, "[--%02i ", level);
// 123 45 678
}
//P2 + P3 -> turn right
else if ( SW_PRESET3.state && !SW_PRESET1.state ) {
vfd_setSpeedLevel(level); //TODO: use poti input for level
vfd_setSpeedLevel(level);
vfd_setState(true, FWD);
sprintf(buf_disp2, " %02i--]", level);
}
@ -507,13 +499,25 @@ void task_control(void *pvParameter)
}
//----------------------------
//------- control lamp -------
//----------------------------
//basic functionality of lamp:
//turn on when not idling
//TODO: add switch-case for different sates
//e.g. blink with different frequencies in different states
if (controlState != systemState_t::COUNTING
&& controlState != systemState_t::TARGET_REACHED) {
gpio_set_level(GPIO_LAMP, 1);
}
else {
gpio_set_level(GPIO_LAMP, 0);
}
#endif
//TODO: blink disp2 when set button pressed
//TODO: blink disp2 when preset button pressed (exept manual mode)
//TODO: write "MAN CTL" to disp2 when in manual mode
//TODO: display or blink "REACHED" when reached state and start pressed
}
}

4
main/control.hpp
View File

@ -26,8 +26,10 @@ extern "C"
//enum describing the state of the system
enum class systemState_t {COUNTING, WINDING_START, WINDING, TARGET_REACHED, AUTO_CUT_WAITING, CUTTING, MANUAL};
//array with enum as strings for logging states
extern const char* systemStateStr[7];
//task that controls the entire machine (has to be created as task in main function)
void task_control(void *pvParameter);

2
main/cutter.cpp
View File

@ -22,8 +22,6 @@ static const char *TAG = "cutter"; //tag for logging
//=========================
//========= start =========
//=========================

17
main/main.cpp
View File

@ -13,19 +13,21 @@ extern "C"
#include "config.hpp"
#include "control.hpp"
#include "buzzer.hpp"
#include "switchesAnalog.hpp"
//=================================
//=========== functions ===========
//=================================
//--- configure output ---
//function to configure gpio pin as output
void gpio_configure_output(gpio_num_t gpio_pin){
gpio_pad_select_gpio(gpio_pin);
gpio_set_direction(gpio_pin, GPIO_MODE_OUTPUT);
}
//--- init gpios ---
void init_gpios(){
//--- outputs ---
//4x stepper mosfets
@ -36,7 +38,7 @@ void init_gpios(){
//gpio_configure_output(GPIO_VFD_D2); only used with 7.5kw vfd
//2x power mosfets
gpio_configure_output(GPIO_MOS1); //mos1
gpio_configure_output(GPIO_LAMP); //lamp
gpio_configure_output(GPIO_LAMP); //llamp (mos2)
//onboard relay and buzzer
gpio_configure_output(GPIO_RELAY);
gpio_configure_output(GPIO_BUZZER);
@ -47,12 +49,6 @@ void init_gpios(){
//initialize and configure ADC
adc1_config_width(ADC_WIDTH_BIT_12); //=> max resolution 4096
adc1_config_channel_atten(ADC_CHANNEL_POTI, ADC_ATTEN_DB_11); //max voltage
////initialize input for cutter position switch with pullup (now done via evaluatedSwitch construcor)
//gpio_pad_select_gpio(GPIO_CUTTER_POS_SW);
//gpio_set_direction(GPIO_CUTTER_POS_SW, GPIO_MODE_INPUT);
//gpio_pad_select_gpio(GPIO_CUTTER_POS_SW);
//gpio_set_pull_mode(GPIO_CUTTER_POS_SW, GPIO_PULLUP_ONLY);
}
@ -60,8 +56,6 @@ void init_gpios(){
//======================================
//============ buzzer task =============
//======================================
//TODO: move the task creation to buzzer class (buzzer.cpp)
//e.g. only have function buzzer.createTask() in app_main
void task_buzzer( void * pvParameters ){
ESP_LOGI("task_buzzer", "Start of buzzer task...");
//run function that waits for a beep events to arrive in the queue
@ -71,8 +65,6 @@ void task_buzzer( void * pvParameters ){
//======================================
//=========== main function ============
//======================================
@ -97,5 +89,4 @@ extern "C" void app_main()
//beep at startup
buzzer.beep(3, 70, 50);
}