Skip to content

Commit

Permalink
[ext] example for json usage added
Browse files Browse the repository at this point in the history
  • Loading branch information
hshose authored and salkinium committed May 19, 2024
1 parent cde35ed commit 4c79529
Show file tree
Hide file tree
Showing 2 changed files with 208 additions and 0 deletions.
194 changes: 194 additions & 0 deletions examples/nucleo_g474re/flash_json/main.cpp
Original file line number Diff line number Diff line change
@@ -0,0 +1,194 @@
/*
* Copyright (c) 2024, Henrik Hose
*
* This file is part of the modm project.
*
* This Source Code Form is subject to the terms of the Mozilla Public
* License, v. 2.0. If a copy of the MPL was not distributed with this
* file, You can obtain one at http://mozilla.org/MPL/2.0/.
*/

#include <modm/board.hpp>
#include <modm/debug/logger.hpp>
#include <nlohmann-json/json.hpp>

#undef MODM_LOG_LEVEL
#define MODM_LOG_LEVEL modm::log::INFO

// ----------------------------------------------------------------------------

extern "C" const uint32_t __flash_reserved_start[];

using json = nlohmann::json;

constexpr auto max_flash_pages{256};

namespace data
{
struct person
{
std::string name;
float height;
int age;
auto
operator<=>(const person&) const = default;
};

void
to_json(json& j, const person& p)
{
j = json{{"name", p.name}, {"height", p.height}, {"age", p.age}};
}

void
from_json(const json& j, person& p)
{
j.at("name").get_to(p.name);
j.at("height").get_to(p.height);
j.at("age").get_to(p.age);
}
} // namespace data

int
main()
{
Board::initialize();

MODM_LOG_INFO << "\n\n+++++++++++++++++++++++++++" << modm::endl;
MODM_LOG_INFO << "++ NLOHMANN JSON example ++" << modm::endl;
MODM_LOG_INFO << "+++++++++++++++++++++++++++\n" << modm::endl;

data::person alice_struct = {"Alice", 1.85, 80};
json alice_json = alice_struct;

// basic JSON character string usage
{
auto alice_json_string = alice_json.dump();

// imagine that we transmit this string over some interface
MODM_LOG_INFO << "JSON from struct is: " << alice_json_string.c_str() << modm::endl;

// and now we can retrieve the struct from the json object
json retrieved_alice_json = json::parse(alice_json_string);

// JSON is fairly self-annotated, so we might not even need the original struct
MODM_LOG_INFO << "\nRetrieved from string JSON has fields ... ";
for (auto& [key, value] : retrieved_alice_json.items())
{
MODM_LOG_INFO << key.c_str() << ", ";
}
MODM_LOG_INFO << modm::endl;
MODM_LOG_INFO.flush();

// check if retrieved struct is same
auto retrieved_alice_struct = retrieved_alice_json.template get<data::person>();
if (retrieved_alice_struct == alice_struct)
{
MODM_LOG_INFO << "\nRetrieved from string and original struct are identical"
<< modm::endl;
}
MODM_LOG_INFO.flush();
}

// basic binary JSON usage
{
// convert to BSON
auto alice_binary = json::to_bson(alice_json);

MODM_LOG_INFO << "\nBinary JSON (BSON): ";
for (const auto& byte : alice_binary) { MODM_LOG_INFO.printf(" 0x%02x", byte); }
MODM_LOG_INFO << modm::endl;

// put BSON in reserved flash
uint32_t err{0};
const size_t page_start =
Flash::getPage(reinterpret_cast<uint32_t>(&__flash_reserved_start));
const size_t num_bytes = alice_binary.size();
const size_t flash_page_size = Flash::getSize(page_start);
const size_t end_page = page_start + (num_bytes + flash_page_size - 1) / flash_page_size;
if (end_page >= max_flash_pages)
{
MODM_LOG_ERROR << "\nRequested flash end page exceeds flash [" << page_start << ", "
<< end_page << ")" << modm::endl;
MODM_LOG_ERROR.flush();
while (1)
;
}

// erase the pages before programming
MODM_LOG_INFO << "\nErasing flash sectors [" << page_start << ", " << end_page << ")"
<< modm::endl;
MODM_LOG_INFO.flush();
if (not Flash::unlock())
{
MODM_LOG_ERROR << "Flash unlock failed!" << modm::endl;
while (1)
;
}
for (size_t page{page_start}; page < end_page; page++) err |= Flash::erase(page);
if (err != 0)
{
MODM_LOG_ERROR << "\nThere was an error while erasing flash!" << modm::endl;
MODM_LOG_ERROR.flush();
while (1)
;
}

// pad the data with zeros to fit flash words
size_t unpadded_size{alice_binary.size()};
size_t word_size{sizeof(Flash::MaxWordType)};
if (auto padding = (word_size - unpadded_size % word_size) % word_size; padding > 0)
{
alice_binary.resize(alice_binary.size() + padding, 0);
}

// now, write the padded data
MODM_LOG_INFO << "\nWriting, word size: " << word_size
<< ", num of bytes (payload): " << unpadded_size
<< ", num of bytes (padded): " << alice_binary.size() << "... ";

const auto flash_write_base_addr{reinterpret_cast<uint32_t>(Flash::getAddr(page_start))};
for (size_t ii = 0; ii < alice_binary.size(); ii += sizeof(Flash::MaxWordType))
{
Flash::MaxWordType outdata;
memcpy(&outdata, &alice_binary[ii], sizeof(Flash::MaxWordType));
err |= Flash::program(flash_write_base_addr + ii, outdata);
}

if (err != 0)
{
MODM_LOG_ERROR << "\nThere was an error while programming flash!" << modm::endl;
MODM_LOG_ERROR.flush();
while (1)
;
}
MODM_LOG_INFO << "Writing complete! " << modm::endl;
MODM_LOG_INFO.flush();

// we can now read BSON back from flash, first 4 bytes entry is the size
uint32_t read_len;
memcpy(&read_len, Flash::getAddr(page_start), sizeof(read_len));

// read the actual data
MODM_LOG_INFO << "\nReading BSON of size " << read_len << " from flash: ";
auto raw_bytes =
std::vector<uint8_t>(Flash::getAddr(page_start), Flash::getAddr(page_start) + read_len);
for (const auto& byte : raw_bytes) { MODM_LOG_INFO.printf(" 0x%02x", byte); }
MODM_LOG_INFO << modm::endl;
MODM_LOG_INFO.flush();

// reconstruct the data
auto retrieved_alice_json = json::from_bson(raw_bytes);
auto retrieved_alice_struct = retrieved_alice_json.template get<data::person>();
if (retrieved_alice_struct == alice_struct)
{
MODM_LOG_INFO << "\nRetrieved from flash and original struct are identical"
<< modm::endl;
MODM_LOG_INFO.flush();
}
}

while (1)
;
return 0;
}
14 changes: 14 additions & 0 deletions examples/nucleo_g474re/flash_json/project.xml
Original file line number Diff line number Diff line change
@@ -0,0 +1,14 @@
<library>
<extends>modm:nucleo-g474re</extends>
<options>
<option name="modm:build:build.path">../../../build/nucleo_g474re/flash_json</option>
<option name="modm:platform:cortex-m:linkerscript.flash_reserved">1024*16</option>
</options>
<modules>
<module>modm:debug</module>
<module>modm:platform:gpio</module>
<module>modm:platform:flash</module>
<module>modm:nlohmann-json</module>
<module>modm:build:scons</module>
</modules>
</library>

0 comments on commit 4c79529

Please sign in to comment.