mirror of
https://github.com/eried/portapack-mayhem.git
synced 2024-12-14 18:24:34 -05:00
84 lines
2.4 KiB
C++
84 lines
2.4 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] = {(uint16_t)Command::COMMAND_APP_TRANSFER, index, offset / transfer_block_size};
|
||
|
|
|
||
|
|
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
|