mirror of
https://github.com/eried/portapack-mayhem.git
synced 2024-12-14 02:04:31 -05:00
98 lines
3.0 KiB
C++
98 lines
3.0 KiB
C++
/*
|
|
* Copyright (C) 2024 Bernd Herzog
|
|
*
|
|
* This file is part of PortaPack.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License as published by
|
|
* the Free Software Foundation; either version 2, or (at your option)
|
|
* any later version.
|
|
*
|
|
* This program is distributed in the hope that 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; see the file COPYING. If not, write to
|
|
* the Free Software Foundation, Inc., 51 Franklin Street,
|
|
* Boston, MA 02110-1301, USA.
|
|
*/
|
|
|
|
#include "i2cdev_ppmod.hpp"
|
|
#include "portapack.hpp"
|
|
|
|
#include <optional>
|
|
|
|
namespace i2cdev {
|
|
|
|
bool I2cDev_PPmod::init(uint8_t addr_) {
|
|
if (addr_ != I2CDEV_PPMOD_ADDR_1) return false;
|
|
addr = addr_;
|
|
model = I2CDECMDL_PPMOD;
|
|
|
|
return true;
|
|
}
|
|
|
|
void I2cDev_PPmod::update() {
|
|
}
|
|
|
|
std::optional<I2cDev_PPmod::device_info> I2cDev_PPmod::readDeviceInfo() {
|
|
Command cmd = Command::COMMAND_INFO;
|
|
I2cDev_PPmod::device_info info;
|
|
|
|
bool success = i2c_read((uint8_t*)&cmd, 2, (uint8_t*)&info, sizeof(I2cDev_PPmod::device_info));
|
|
if (success == false) {
|
|
return std::nullopt;
|
|
}
|
|
|
|
return info;
|
|
}
|
|
|
|
std::optional<I2cDev_PPmod::standalone_app_info> I2cDev_PPmod::getStandaloneAppInfo(uint32_t index) {
|
|
Command cmd = Command::COMMAND_APP_INFO;
|
|
uint32_t data = (uint32_t)cmd + (index << 16);
|
|
I2cDev_PPmod::standalone_app_info info;
|
|
|
|
bool success = i2c_read((uint8_t*)&data, 4, (uint8_t*)&info, sizeof(I2cDev_PPmod::standalone_app_info));
|
|
if (success == false) {
|
|
return std::nullopt;
|
|
}
|
|
|
|
return info;
|
|
}
|
|
|
|
constexpr size_t transfer_block_size = 128;
|
|
|
|
std::vector<uint8_t> I2cDev_PPmod::downloadStandaloneApp(uint32_t index, size_t offset) {
|
|
if (offset % transfer_block_size != 0) {
|
|
return {};
|
|
}
|
|
|
|
uint16_t data[3] = {
|
|
static_cast<uint16_t>(Command::COMMAND_APP_TRANSFER),
|
|
static_cast<uint16_t>(index & 0xFFFF), // keep index in 16 bits range
|
|
static_cast<uint16_t>((offset / transfer_block_size) & 0xFFFF) // keep (offset / transfer_block_size) in 16 bits range
|
|
};
|
|
|
|
/*
|
|
// TODO: check if there was an out of range, manage error
|
|
if (index > std::numeric_limits<uint16_t>::max()) {
|
|
// manage error if index is bigger than a 16 bits value
|
|
}
|
|
// TODO: check if there was an out of range, manage error
|
|
if (offset / transfer_block_size > std::numeric_limits<uint16_t>::max()) {
|
|
// manage error if (offset / transfer_block_size ) is bigger than a 16 bits value
|
|
}
|
|
*/
|
|
std::vector<uint8_t> ret(transfer_block_size);
|
|
bool success = i2c_read((uint8_t*)&data, sizeof(data), (uint8_t*)ret.data(), transfer_block_size);
|
|
if (success == false) {
|
|
return {};
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
} // namespace i2cdev
|