mirror of
https://github.com/Atmosphere-NX/Atmosphere
synced 2024-11-10 07:06:34 +00:00
57 lines
2.4 KiB
C++
57 lines
2.4 KiB
C++
|
/*
|
||
|
* 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/>.
|
||
|
*/
|
||
|
#pragma once
|
||
|
#include <vapours.hpp>
|
||
|
#include <stratosphere/i2c/i2c_types.hpp>
|
||
|
#include <stratosphere/i2c/i2c_command_list_formatter.hpp>
|
||
|
#include <stratosphere/i2c/i2c_bus_api.hpp>
|
||
|
|
||
|
namespace ams::i2c {
|
||
|
|
||
|
template<typename RegType> requires std::unsigned_integral<RegType>
|
||
|
Result ReadSingleRegister(const I2cSession &session, u8 address, RegType *out) {
|
||
|
/* Check pre-conditions. */
|
||
|
AMS_ABORT_UNLESS(out != nullptr);
|
||
|
|
||
|
constexpr i2c::TransactionOption StartOption = i2c::TransactionOption_StartCondition;
|
||
|
constexpr i2c::TransactionOption StopOption = static_cast<i2c::TransactionOption>(i2c::TransactionOption_StartCondition | i2c::TransactionOption_StopCondition);
|
||
|
|
||
|
u8 cmd_list[CommandListLengthMax];
|
||
|
i2c::CommandListFormatter formatter(cmd_list, sizeof(cmd_list));
|
||
|
|
||
|
R_TRY(formatter.EnqueueSendCommand(StartOption, std::addressof(address), sizeof(address)));
|
||
|
R_TRY(formatter.EnqueueReceiveCommand(StopOption, sizeof(*out)));
|
||
|
|
||
|
R_TRY(i2c::ExecuteCommandList(out, sizeof(*out), session, cmd_list, formatter.GetCurrentLength()));
|
||
|
|
||
|
return ResultSuccess();
|
||
|
}
|
||
|
|
||
|
template<typename RegType> requires std::unsigned_integral<RegType>
|
||
|
Result WriteSingleRegister(const I2cSession &session, u8 address, RegType value) {
|
||
|
/* Prepare buffer. */
|
||
|
u8 buf[sizeof(address) + sizeof(value)];
|
||
|
std::memcpy(buf + 0, std::addressof(address), sizeof(address));
|
||
|
std::memcpy(buf + sizeof(address), std::addressof(value), sizeof(value));
|
||
|
|
||
|
constexpr i2c::TransactionOption StopOption = static_cast<i2c::TransactionOption>(i2c::TransactionOption_StartCondition | i2c::TransactionOption_StopCondition);
|
||
|
R_TRY(i2c::Send(session, buf, sizeof(buf), StopOption));
|
||
|
|
||
|
return ResultSuccess();
|
||
|
}
|
||
|
|
||
|
}
|