logger/dout.c at master · catompiler/logger · GitHub

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
112
113
114
115
116
117
118
119
120
121
122
#include "dout.h"
#include "defs/defs.h"
#include <string.h>


//! Структура канала цифрового выхода.
typedef struct _Dout_Channel {
	GPIO_TypeDef* gpio; //!< GPIO.
	gpio_pin_t pin; //!< Пин.
	dout_mode_t mode; //!< Режим.
    dout_type_t type; //!< Тип.
	dout_state_t state; //!< Состояние выхода.
} dout_channel_t;


//! Структура цифровых выходов.
typedef struct _Dout {
	dout_channel_t channels[DOUT_COUNT]; //!< Каналы.
} dout_t;

//! Цифровые выхода.
static dout_t dout;


//! Получает канал цифрового выхода по номеру.
ALWAYS_INLINE static dout_channel_t* dout_channel(size_t n)
{
	return &dout.channels[n];
}

//! Получает текущее состояние выхода.
ALWAYS_INLINE static err_t dout_channel_set_state_inst(dout_channel_t* channel, dout_state_t state)
{
	if(channel->gpio == NULL || channel->pin == 0) return E_STATE;

	gpio_state_t inst_state = GPIO_STATE_OFF;

	if(state == DOUT_ON){
		inst_state = (channel->mode == DOUT_NORMAL) ? GPIO_STATE_ON : GPIO_STATE_OFF;
	}else{
		inst_state = (channel->mode == DOUT_NORMAL) ? GPIO_STATE_OFF : GPIO_STATE_ON;
	}

	if(inst_state == GPIO_STATE_ON){
		gpio_set(channel->gpio, channel->pin);
	}else{
		gpio_reset(channel->gpio, channel->pin);
	}

	channel->state = state;

	return E_NO_ERROR;
}


err_t dout_init(void)
{
	memset(&dout, 0x0, sizeof(dout_t));

	return E_NO_ERROR;
}

err_t dout_channel_init(size_t n, GPIO_TypeDef* gpio, gpio_pin_t pin)
{
	if(n >= DOUT_COUNT) return E_OUT_OF_RANGE;
	if(gpio == NULL || pin == 0) return E_INVALID_VALUE;

	dout_channel_t* channel = dout_channel(n);

	channel->gpio = gpio;
	channel->pin = pin;

	return E_NO_ERROR;
}

err_t dout_channel_setup(size_t n, dout_mode_t mode, dout_type_t type)
{
	if(n >= DOUT_COUNT) return E_OUT_OF_RANGE;

	dout_channel_t* channel = dout_channel(n);

	channel->mode = mode;
	channel->type = type;

	return E_NO_ERROR;
}

void dout_process(void)
{
	dout_channel_t* channel = NULL;

	size_t i;
	for(i = 0; i < DOUT_COUNT; i ++){
		channel = dout_channel(i);

		dout_channel_set_state_inst(channel, channel->state);
	}
}

err_t dout_set_state(size_t n, dout_state_t state)
{
	if(n >= DOUT_COUNT) return E_OUT_OF_RANGE;

	dout_channel_t* channel = dout_channel(n);

	channel->state = state;

	return E_NO_ERROR;
}

void dout_set_type_state(dout_type_t type, dout_state_t state)
{
    dout_channel_t* channel = NULL;

    size_t i;
    for(i = 0; i < DOUT_COUNT; i ++){
        channel = dout_channel(i);

        if(channel->type == type) channel->state = state;
    }
}