1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
|
/*
* spreadspace avr utils
*
*
* Copyright (C) 2013 Christian Pointner <equinox@spreadspace.org>
* Othmar Gsenger <otti@wirdorange.org>
*
* This file is part of spreadspace avr utils.
*
* spreadspace avr utils is free software: you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation, either version 3 of the License, or
* any later version.
*
* spreadspace avr utils is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with spreadspace avr utils. If not, see <http://www.gnu.org/licenses/>.
*/
#include "statemachine.h"
#include "stepper.h"
#include "eventqueue.h"
#include "limits.h"
#include "ledmatrix.h"
#include <stdio.h>
typedef enum state_enum {reset, closed, closing, opened, opening, timeout_after_open, timeout_after_close, error, manual_movement} state_t;
state_t state = reset;
void change_state(state_t new_state)
{
if (new_state == state)
return;
printf("state: %d\n\r",new_state);
switch(new_state) {
case reset:
break;
case closed: ledmatrix(red); break;
case closing: ledmatrix(red_moving); break;
case opened: ledmatrix(green); break;
case opening: ledmatrix(green_moving); break;
case timeout_after_open: ledmatrix(green_blink); break;
case timeout_after_close: ledmatrix(red_blink); break;
case error: ledmatrix(rg_blink); break;
case manual_movement: ledmatrix(rg_moving); break;
break;
}
state = new_state;
}
void statemachine_task_limits(void)
{
limits_t limits = limits_get();
if (limits == both)
return change_state(error);
switch(state) {
case reset:
switch(limits) {
case open:
return change_state(opened);
case close:
return change_state(closed);
default:
return change_state(closing);
}
case closed:
case opened:
switch(limits) {
case open:
return change_state(opened);
case close:
return change_state(closed);
default:
return change_state(manual_movement);
}
case manual_movement:
case timeout_after_open:
case timeout_after_close:
case closing:
case opening:
switch(limits) {
case open:
return change_state(opened);
case close:
return change_state(closed);
default:
return;
}
case error:
break;
}
}
void statemachine_task_cmd(void)
{
event_t event = eventqueue_pop();
}
void statemachine_task(void)
{
statemachine_task_limits();
statemachine_task_cmd();
}
|
