nold/Atmosphere
1
0
Fork 0
mirror of https://github.com/Atmosphere-NX/Atmosphere synced 2024-12-22 20:31:14 +00:00
Code Issues Projects Releases Packages Wiki Activity

gpio: add missing driver functions for boot

Browse source
This commit is contained in:
Michael Scire 2020-11-01 23:04:01 -08:00
parent 22ae1d5bd3
commit 4cc4f5fdb0
2 changed files with 139 additions and 0 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

137
libraries/libstratosphere/source/gpio/driver/gpio_pad_api.cpp Normal file
View file

@ -0,0 +1,137 @@
/*
* Copyright (c) 2018-2020 Atmosphère-NX
*
* This program is free software; you can redistribute it and/or modify it
* under the terms and conditions of the GNU General Public License,
* version 2, as published by the Free Software Foundation.
*
* This program is distributed in the hope 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 this program. If not, see <http://www.gnu.org/licenses/>.
*/
#include <stratosphere.hpp>
#include "impl/gpio_driver_core.hpp"
namespace ams::gpio::driver {
namespace {
Result OpenSessionImpl(GpioPadSession *out, Pad *pad, ddsf::AccessMode access_mode) {
/* Construct the session. */
auto *session = new (std::addressof(impl::GetPadSessionImpl(*out))) impl::PadSessionImpl;
auto session_guard = SCOPE_GUARD { session->~PadSessionImpl(); };
/* Open the session. */
R_TRY(session->Open(pad, access_mode));
session_guard.Cancel();
return ResultSuccess();
}
}
Result OpenSession(GpioPadSession *out, DeviceCode device_code, ddsf::AccessMode access_mode) {
/* Find the pad. */
Pad *pad = nullptr;
R_TRY(impl::FindPad(std::addressof(pad), device_code));
AMS_ASSERT(pad != nullptr);
/* Sanitize the access mode. */
if ((access_mode & ~(ddsf::AccessMode_ReadWrite)) != 0) {
access_mode = ddsf::AccessMode_None;
}
/* Try to open the session with the desired mode. */
R_TRY_CATCH(OpenSessionImpl(out, pad, access_mode)) {
R_CATCH(ddsf::ResultAccessModeDenied) {
/* Our current access mode was denied. Try adding the shared flag. */
R_TRY(OpenSessionImpl(out, pad, static_cast<ddsf::AccessMode>(access_mode | ddsf::AccessMode_Shared)));
}
} R_END_TRY_CATCH;
return ResultSuccess();
}
void CloseSession(GpioPadSession *session) {
AMS_ASSERT(session != nullptr);
impl::GetOpenPadSessionImpl(*session).~PadSessionImpl();
}
Result SetDirection(GpioPadSession *session, gpio::Direction direction) {
/* Check that we have a valid session. */
AMS_ASSERT(session != nullptr);
auto &impl = impl::GetOpenPadSessionImpl(*session);
R_UNLESS(impl.IsOpen(), gpio::ResultNotOpen());
/* Check that we can perform the access. */
R_UNLESS(impl.CheckAccess(ddsf::AccessMode_Write), ddsf::ResultPermissionDenied());
/* Get the pad. */
auto &pad = impl.GetDevice().SafeCastTo<Pad>();
/* Perform the call. */
R_TRY(pad.GetDriver().SafeCastTo<IGpioDriver>().SetDirection(std::addressof(pad), direction));
return ResultSuccess();
}
Result GetDirection(gpio::Direction *out, GpioPadSession *session) {
/* Check that we have a valid session. */
AMS_ASSERT(session != nullptr);
auto &impl = impl::GetOpenPadSessionImpl(*session);
R_UNLESS(impl.IsOpen(), gpio::ResultNotOpen());
/* Check that we can perform the access. */
R_UNLESS(impl.CheckAccess(ddsf::AccessMode_Read), ddsf::ResultPermissionDenied());
/* Get the pad. */
auto &pad = impl.GetDevice().SafeCastTo<Pad>();
/* Perform the call. */
R_TRY(pad.GetDriver().SafeCastTo<IGpioDriver>().GetDirection(out, std::addressof(pad)));
return ResultSuccess();
}
Result SetValue(GpioPadSession *session, gpio::GpioValue value) {
/* Check that we have a valid session. */
AMS_ASSERT(session != nullptr);
auto &impl = impl::GetOpenPadSessionImpl(*session);
R_UNLESS(impl.IsOpen(), gpio::ResultNotOpen());
/* Check that we can perform the access. */
R_UNLESS(impl.CheckAccess(ddsf::AccessMode_Write), ddsf::ResultPermissionDenied());
/* Get the pad. */
auto &pad = impl.GetDevice().SafeCastTo<Pad>();
/* Perform the call. */
R_TRY(pad.GetDriver().SafeCastTo<IGpioDriver>().SetValue(std::addressof(pad), value));
return ResultSuccess();
}
Result GetValue(gpio::GpioValue *out, GpioPadSession *session) {
/* Check that we have a valid session. */
AMS_ASSERT(session != nullptr);
auto &impl = impl::GetOpenPadSessionImpl(*session);
R_UNLESS(impl.IsOpen(), gpio::ResultNotOpen());
/* Check that we can perform the access. */
R_UNLESS(impl.CheckAccess(ddsf::AccessMode_Read), ddsf::ResultPermissionDenied());
/* Get the pad. */
auto &pad = impl.GetDevice().SafeCastTo<Pad>();
/* Perform the call. */
R_TRY(pad.GetDriver().SafeCastTo<IGpioDriver>().GetValue(out, std::addressof(pad)));
return ResultSuccess();
}
}

2
libraries/libvapours/include/vapours/results/gpio_results.hpp
View file

@ -26,4 +26,6 @@ namespace ams::gpio {
R_DEFINE_ERROR_RESULT(DeviceNotFound, 3);
R_DEFINE_ERROR_RESULT(InvalidArgument, 4);
R_DEFINE_ERROR_RESULT(NotOpen, 6);
}