-
Notifications
You must be signed in to change notification settings - Fork 10
/
gpio.cpp
124 lines (99 loc) · 3.17 KB
/
gpio.cpp
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
123
124
/**
* Copyright © 2017 IBM Corporation
*
* Licensed under the Apache License, Version 2.0 (the "License");
* you may not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS,
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
#include "gpio.hpp"
#include <fcntl.h>
#include <sys/ioctl.h>
#include <phosphor-logging/elog-errors.hpp>
#include <phosphor-logging/elog.hpp>
#include <phosphor-logging/log.hpp>
#include <xyz/openbmc_project/Common/error.hpp>
#include <cassert>
namespace phosphor
{
namespace gpio
{
using namespace phosphor::logging;
using InternalFailure =
sdbusplus::xyz::openbmc_project::Common::Error::InternalFailure;
Value GPIO::read()
{
assert(direction == Direction::input);
requestLine();
gpiohandle_data data{};
auto rc = ioctl(lineFD(), GPIOHANDLE_GET_LINE_VALUES_IOCTL, &data);
if (rc < 0)
{
auto e = errno;
log<level::ERR>("Failed GET_LINE_VALUES ioctl", entry("ERRNO=%d", e));
elog<InternalFailure>();
}
return (data.values[0] == 0) ? Value::low : Value::high;
}
void GPIO::set(Value value)
{
assert(direction == Direction::output);
requestLine(value);
gpiohandle_data data{};
data.values[0] = static_cast<gpioValue_t>(value);
auto rc = ioctl(lineFD(), GPIOHANDLE_SET_LINE_VALUES_IOCTL, &data);
if (rc == -1)
{
auto e = errno;
log<level::ERR>("Failed SET_LINE_VALUES ioctl", entry("ERRNO=%d", e));
elog<InternalFailure>();
}
}
void GPIO::requestLine(Value defaultValue)
{
// Only need to do this once
if (lineFD)
{
return;
}
power::util::FileDescriptor fd{open(device.c_str(), 0)};
if (fd() == -1)
{
auto e = errno;
log<level::ERR>("Failed opening GPIO device",
entry("DEVICE=%s", device.c_str()),
entry("ERRNO=%d", e));
elog<InternalFailure>();
}
// Make an ioctl call to request the GPIO line, which will
// return the descriptor to use to access it.
gpiohandle_request request{};
strncpy(request.consumer_label, "phosphor-power",
sizeof(request.consumer_label));
request.flags = (direction == Direction::input) ? GPIOHANDLE_REQUEST_INPUT
: GPIOHANDLE_REQUEST_OUTPUT;
request.lineoffsets[0] = gpio;
request.lines = 1;
if (direction == Direction::output)
{
request.default_values[0] = static_cast<gpioValue_t>(defaultValue);
}
auto rc = ioctl(fd(), GPIO_GET_LINEHANDLE_IOCTL, &request);
if (rc == -1)
{
auto e = errno;
log<level::ERR>("Failed GET_LINEHANDLE ioctl", entry("GPIO=%d", gpio),
entry("ERRNO=%d", e));
elog<InternalFailure>();
}
lineFD.set(request.fd);
}
} // namespace gpio
} // namespace phosphor