Atmosphere/libraries/libstratosphere/source/gpio/driver/gpio_pad_api.cpp

138 lines
4.9 KiB
C++
Raw Normal View History

/*
* Copyright (c) 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 = std::construct_at(std::addressof(impl::GetPadSessionImpl(*out)));
auto session_guard = SCOPE_GUARD { std::destroy_at(session); };
/* 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);
std::destroy_at(std::addressof(impl::GetOpenPadSessionImpl(*session)));
}
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();
}
}