mirrors/Atmosphere
1
0
Fork 0
mirror of https://github.com/Atmosphere-NX/Atmosphere.git synced 2025-06-04 00:28:51 -04:00
Code Issues Projects Releases Packages Wiki Activity

i2c: add register acccessor helpers

Browse source
This commit is contained in:
Michael Scire 2020-11-09 17:34:47 -08:00 • committed by SciresM
parent 5bd02f128d
commit 7c58a21c4c
6 changed files with 250 additions and 0 deletions
Download patch file Download diff file Expand all files Collapse all files

1
libraries/libstratosphere/include/stratosphere/i2c.hpp
View file

@ -28,3 +28,4 @@
#include <stratosphere/i2c/driver/impl/i2c_i2c_session_impl.hpp>
#include <stratosphere/i2c/i2c_api.hpp>
#include <stratosphere/i2c/i2c_bus_api.hpp>
#include <stratosphere/i2c/i2c_register_accessor.hpp>

56
libraries/libstratosphere/include/stratosphere/i2c/i2c_register_accessor.hpp Normal file
View file

@ -0,0 +1,56 @@
/*
* 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();
}
}