Skip to content
Snippets Groups Projects

Compare revisions

Changes are shown as if the source revision was being merged into the target revision. Learn more about comparing revisions.

Source

Select target project
No results found
Select Git revision

Target

Select target project
  • avn/swd/skyward-boardcore
  • emilio.corigliano/skyward-boardcore
  • ettore.pane/skyward-boardcore
  • giulia.facchi/skyward-boardcore
  • valerio.flamminii/skyward-boardcore
  • nicolo.caruso/skyward-boardcore
6 results
Select Git revision
Show changes
Expand all Show whitespace changes
Inline Side-by-side
Showing
with 125 additions and 69389 deletions
cmake/dependencies.cmake
View file @ 0913ed8b
......@@ -29,7 +29,8 @@ add_subdirectory(${SBS_BASE}/libs/miosix-host EXCLUDE_FROM_ALL)
include(${SBS_BASE}/libs/mxgui/cmake/mxgui.cmake)
# Serialization library
add_subdirectory(${SBS_BASE}/libs/tscpp EXCLUDE_FROM_ALL)
add_subdirectory(${SBS_BASE}/libs/socrate EXCLUDE_FROM_ALL)
# Eigen library
set(CMAKE_BUILD_WITH_INSTALL_RPATH ON)
......
cmake/sbs.cmake
View file @ 0913ed8b
......@@ -21,36 +21,52 @@
enable_language(C CXX ASM)
set(CMAKE_CXX_STANDARD 14)
set(CMAKE_CXX_STANDARD_REQUIRED ON)
# Load in SBS_BASE the project path
cmake_path(GET CMAKE_CURRENT_LIST_DIR PARENT_PATH SBS_BASE)
# Load in BOARDCORE_PATH the boardcore path
cmake_path(GET CMAKE_CURRENT_LIST_DIR PARENT_PATH BOARDCORE_PATH)
# Add the version information header to the global include path, so that all
# targets defined after this point will have access to it (Boardcore, Kernel)
include_directories(${BOARDCORE_PATH}/version)
# Include the Boardcore libraries
list(APPEND CMAKE_MODULE_PATH ${CMAKE_CURRENT_LIST_DIR})
include(boardcore)
# Command to print all the available boards used by the sbs script
string(REPLACE ";" "\\n" BOARDS_STR "${MIOSIX_BOARDS};${BOARDCORE_BOARDS}")
add_custom_target(
help-boards
COMMAND printf ${BOARDS_STR}
COMMENT "All boards available:"
VERBATIM
)
# Function to link the Boardcore library to the target
function(sbs_target TARGET OPT_BOARD)
if(NOT OPT_BOARD)
message(FATAL_ERROR "No board selected")
endif()
# The only include directory of Boardcore is shared!
target_include_directories(${TARGET} PRIVATE src/shared)
# Define the version information generation command
add_custom_target(${TARGET}-version-info
BYPRODUCTS ${CMAKE_CURRENT_BINARY_DIR}/generated/${TARGET}/version.cpp
COMMAND "${CMAKE_COMMAND}"
"-D" "TARGET_NAME=${TARGET}"
"-D" "CMAKE_BUILD_TYPE=${CMAKE_BUILD_TYPE}"
"-D" "BOARDCORE_PATH=${BOARDCORE_PATH}"
"-D" "OUT_DIR=${CMAKE_CURRENT_BINARY_DIR}/generated/${TARGET}"
"-P" "${BOARDCORE_PATH}/cmake/version.cmake"
COMMENT "Generating version information file for ${TARGET}"
VERBATIM
)
# Build the generated version information file as part of the target
target_sources(${TARGET} PRIVATE
${CMAKE_CURRENT_BINARY_DIR}/generated/${TARGET}/version.cpp
)
if(CMAKE_CROSSCOMPILING)
# Link the embedded Boardcore library
target_link_libraries(${TARGET} PRIVATE Skyward::Boardcore::${OPT_BOARD})
# Linker script and linking options are eredited from the kernel library
# Linker script and linking options are inherited from the kernel library
# Add a post build command to create the hex file to flash on the board
add_custom_command(
......
cmake/version.cmake 0 → 100644
View file @ 0913ed8b
# Copyright (c) 2025 Skyward Experimental Rocketry
# Author: Niccolò Betto
#
# Permission is hereby granted, free of charge, to any person obtaining a copy
# of this software and associated documentation files (the "Software"), to deal
# in the Software without restriction, including without limitation the rights
# to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
# copies of the Software, and to permit persons to whom the Software is
# furnished to do so, subject to the following conditions:
#
# The above copyright notice and this permission notice shall be included in
# all copies or substantial portions of the Software.
#
# THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
# IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
# FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
# AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
# LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
# OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
# THE SOFTWARE.
# --- Version Information File Generation ---
# Find Git executable
find_package(Git REQUIRED QUIET)
set(GIT_WORKING_DIR ${CMAKE_SOURCE_DIR})
# Determine dirty status
execute_process(
COMMAND ${GIT_EXECUTABLE} describe --dirty --always --broken
WORKING_DIRECTORY ${GIT_WORKING_DIR}
OUTPUT_VARIABLE GIT_DESCRIBE_OUTPUT # We don't use the output directly, just for the dirty check
OUTPUT_STRIP_TRAILING_WHITESPACE
RESULT_VARIABLE GIT_DESCRIBE_RESULT
ERROR_QUIET # Ignore errors
)
set(GIT_DIRTY_SUFFIX "")
# Check if the command succeeded AND if its output ends with "-dirty"
if(GIT_DESCRIBE_RESULT EQUAL 0 AND GIT_DESCRIBE_OUTPUT MATCHES "-dirty$")
set(GIT_DIRTY_SUFFIX "-dirty")
endif()
# Get *annotated* tag name
execute_process(
COMMAND ${GIT_EXECUTABLE} describe --exact-match HEAD
WORKING_DIRECTORY ${GIT_WORKING_DIR}
OUTPUT_VARIABLE GIT_TAG # Captures the annotated tag name if successful
OUTPUT_STRIP_TRAILING_WHITESPACE
RESULT_VARIABLE GIT_EXACT_TAG_RESULT # Will be 0 on success, non-zero on failure
ERROR_QUIET # Ignore errors, we expect this to fail when not on an annotated tag
)
# Get branch name
execute_process(
COMMAND ${GIT_EXECUTABLE} rev-parse --abbrev-ref HEAD
WORKING_DIRECTORY ${GIT_WORKING_DIR}
OUTPUT_VARIABLE GIT_BRANCH
OUTPUT_STRIP_TRAILING_WHITESPACE
# No ERROR_QUIET/RESULT_VARIABLE -> CMake halts on git command failure
)
# Get short commit hash
execute_process(
COMMAND ${GIT_EXECUTABLE} rev-parse --short HEAD
WORKING_DIRECTORY ${GIT_WORKING_DIR}
OUTPUT_VARIABLE GIT_REV
OUTPUT_STRIP_TRAILING_WHITESPACE
# No ERROR_QUIET/RESULT_VARIABLE -> CMake halts on git command failure
)
# Determine the version info based on tag match result
set(GIT_VERSION_INFO "")
if(GIT_EXACT_TAG_RESULT EQUAL 0)
# Use the tag name when exactly on an annotated tag
set(GIT_VERSION_INFO "${GIT_TAG}")
else()
# Use branch-rev when not on a tag
set(GIT_VERSION_INFO "${GIT_BRANCH}-${GIT_REV}")
endif()
# Construct the final version string
# Format: <annotated_tag>[-dirty] OR <branch>-<hash>[-dirty]
set(GIT_VERSION_STRING "${GIT_VERSION_INFO}${GIT_DIRTY_SUFFIX}")
# Additional variables set by the called of this script via command line args:
# - TARGET_NAME
# - CMAKE_BUILD_TYPE
configure_file(
"${BOARDCORE_PATH}/version/version.cpp.in"
"${OUT_DIR}/version.cpp"
)
data/fault_list.csv deleted 100644 → 0
View file @ 9c4cd6d0
"Category","Name (letters,numbers,underscores,NO SPACES, all caps!)","Description","Generated Name(autogenerated column!)"
"ANAKIN","TEST_FAULT","This fault is for testing","F_ANAKIN_TEST_FAULT"
data/gdb/stm32f4-stlinv2.cfg deleted 100644 → 0
View file @ 9c4cd6d0
# This is an STM32F4 discovery board with a single STM32F407VGT6 chip.
# http://www.st.com/internet/evalboard/product/252419.jsp
source [find interface/stlink-v2-1.cfg]
source [find target/stm32f4x.cfg]
# use hardware reset, connect under reset
reset_config srst_only srst_nogate
data/gdb/stm32f7-stlinv2.cfg deleted 100644 → 0
View file @ 9c4cd6d0
# This is an STM32F7 discovery board with a single STM32F407VGT6 chip.
# http://www.st.com/internet/evalboard/product/252419.jsp
source [find interface/stlink-v2-1.cfg]
source [find target/stm32f7x.cfg]
# use hardware reset, connect under reset
reset_config srst_only srst_nogate
data/gdb/stm32f750.svd deleted 100644 → 0
View file @ 9c4cd6d0
This diff is collapsed.
mavlink-skyward-lib @ ac64dd52
Compare 7abedf97...ac64dd52
Subproject commit 7abedf9773b3ebce9d14687d13544f40fad5577f
Subproject commit ac64dd5294f23f78a89f0f7c335c7a4f7f5394fd
miosix-kernel @ da07e825
Compare a52d94ac...da07e825
Subproject commit a52d94acbfd617ae567a5efc1626e9b88703a0dd
Subproject commit da07e825bc6c02b86cef8e1ec6e62b4d1978b762
socrate @ 1864cb81
Subproject commit 1864cb81475415af4a4daf7842d2a39295448142
tscpp @ 935bf194
Compare 935bf194...935bf194
Subproject commit 935bf1944e1ddeaf51fd22cdce04a2a97762890f
old_examples/entrypoints/anakin/anakin-accel.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Authors: Alain Carlucci, Matteo Piazzolla
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <drivers/BusTemplate.h>
#include <sensors/MAX21105.h>
#include <sensors/MPU9250.h>
#include <sensors/iNemo.h>
using namespace miosix;
#define SENSOR(NAME, CSPORT, CSPIN) \
typedef Gpio<GPIO##CSPORT##_BASE, CSPIN> CS_##NAME; \
typedef ProtocolSPI<busSPI1, CS_##NAME> spi##NAME
#define READ(NAME, ID) spi##NAME::read(ID)
#define TEST(NAME, REG, REF) test_and_print(#NAME, REG, READ(NAME, REG), REF)
#define ACCEL_ENDLESS_TEST
// SPI1
typedef Gpio<GPIOA_BASE, 5> GpioSck;
typedef Gpio<GPIOA_BASE, 6> GpioMiso;
typedef Gpio<GPIOA_BASE, 7> GpioMosi;
typedef BusSPI<1, GpioMosi, GpioMiso, GpioSck> busSPI1;
// clang-format off
// Here's the list of SPI sensors that should be tested
// | NAME | CSPORT | CSPIN |
SENSOR(MPU9250, D, 13);
SENSOR(FXAS21002, G, 10);
SENSOR(MAX21105, E, 2);
SENSOR(MAX31856, B, 11);
SENSOR(LSM9DS0_G, G, 9);
SENSOR(LSM9DS0_A, G, 11);
SENSOR(LPS331AP, E, 4);
SENSOR(MS580301BA07, B, 10);
// clang-format on
static const char mOK[] = "OK";
static const char mKO[] = "FAIL";
int num_ok = 0, num_fail = 0;
typedef MAX21105<spiMAX21105> max_t;
typedef iNEMOLSM9DS0<spiLSM9DS0_G, spiLSM9DS0_A> lsm_t;
typedef MPU9250<spiMPU9250> mpu_t;
typedef struct
{
Vec3 v[3];
} vec_t;
Vec3 calcMid(vec_t data[5], int j)
{
Vec3 ret;
for (int i = 0; i < 5; i++)
ret += Vec3(data[i].v[j]);
ret *= 1.0 / 5.0;
return ret;
}
void calibrate(const vec_t &data[10])
{
for (const auto &i : data)
{
for (int j = 0; j < 3; j++)
{
i->v[j].normalize();
i->v[j] *= EARTH_GRAVITY;
}
}
}
int main()
{
vec_t data[5];
vector<AccelSensor *> accels;
accels.push_back(
new lsm_t(lsm_t::ACC_FS_2G, lsm_t::GYRO_FS_245, lsm_t::COMPASS_FS_2));
accels.push_back(new mpu_t(mpu_t::ACC_FS_2G, mpu_t::GYRO_FS_250));
accels.push_back(new max_t(max_t::ACC_FS_2G, max_t::GYRO_FS_250));
uint16_t cnt = 0;
for (auto jj : accels)
jj->init();
printf("Wait..\n");
Thread::sleep(2000);
printf("Calibrating..\n");
vec_t caa[10];
for (int i = 0; i < 10; i++)
{
for (int j = 0; j < 3; j++)
{
AccelSensor *a = accels[j];
a->updateParams();
caa[i].v[j] = a->getAccel();
}
printf("%02d/10...\r", i + 1);
Thread::sleep(20);
}
calibrate(caa);
while (true)
{
printf("%05d ", cnt);
for (int j = 0; j < 3; j++)
{
AccelSensor *i = accels[j];
i->updateParams();
data[cnt % 5].v[j] = i->getAccel();
Vec3 mid = adjust(data, j);
printf("[%+5.2f,%+5.2f,%+5.2f] ", mid.getX(), mid.getY(),
mid.getZ());
}
printf(" \r");
cnt++;
Thread::sleep(10);
}
}
old_examples/entrypoints/anakin/anakin-demo-board.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Author: Alain Carlucci
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <drivers/BusTemplate.h>
#include <drivers/Leds.h>
#include <drivers/ethernet/UdpManager.h>
#include <drivers/stm32f2_f4_i2c.h>
#include <math/Matrix.h>
#include <math/Vec3.h>
#include <sensors/FXAS21002.h>
#include <sensors/LPS331AP.h>
#include <sensors/MAX21105.h>
#include <sensors/MAX31856.h>
#include <sensors/MPL3115.h>
#include <sensors/MPU9250.h>
#include <sensors/MS580301BA07.h>
#include <sensors/Si7021.h>
#include <sensors/iNemo.h>
using namespace miosix;
using std::vector;
//#define ENABLE_ETHERNET
constexpr uint32_t lp_alpha = 250;
constexpr uint32_t hp_beta = 700;
#define SENSOR(NAME, CSPORT, CSPIN) \
typedef Gpio<GPIO##CSPORT##_BASE, CSPIN> CS_##NAME; \
typedef ProtocolSPI<busSPI1, CS_##NAME> spi##NAME
// SPI1
typedef Gpio<GPIOA_BASE, 5> GpioSck;
typedef Gpio<GPIOA_BASE, 6> GpioMiso;
typedef Gpio<GPIOA_BASE, 7> GpioMosi;
typedef BusSPI<1, GpioMosi, GpioMiso, GpioSck> busSPI1;
// clang-format off
// Here's the list of SPI sensors that should be tested
// | NAME | CSPORT | CSPIN |
SENSOR(MPU9250, D, 13);
SENSOR(FXAS21002, G, 10);
SENSOR(MAX21105, E, 2);
SENSOR(MAX31856, B, 11);
SENSOR(LSM9DS0_G, G, 9);
SENSOR(LSM9DS0_A, G, 11);
SENSOR(LPS331AP, E, 4);
SENSOR(MS580301BA07, B, 10);
// clang-format on
#pragma pack(1)
struct pkt_t
{
float accel[3];
float gyro[3];
float compass[3];
float temperature;
float humidity;
float pressure;
float orientation[3];
};
#pragma pack()
// Please don't judge me for these lines
#define PUSH(a, b, x) \
do \
{ \
sensor_t zz = a, b; \
sensors.push_back(zz); \
x.push_back(zz); \
} while (0)
#define PUSH2(a, b, x, y) \
do \
{ \
sensor_t zz = a, b; \
PUSH(a, b, x); \
y.push_back(zz); \
} while (0)
#define PUSH3(a, b, x, y, z) \
do \
{ \
sensor_t zz = a, b; \
PUSH2(a, b, x, y); \
z.push_back(zz); \
} while (0)
#define PP(name, func) \
do \
{ \
printf("[Sensor] " name " started\n"); \
func; \
} while (0)
class DemoBoard : public Singleton<DemoBoard>
{
friend class Singleton<DemoBoard>;
public:
void init() {}
void update()
{
for (const sensor_t& s : sensors)
(s.sensor)->onSimpleUpdate();
}
// Read a float value
#define RFLO(x, y, k, z, w) \
vector<x> y() const \
{ \
vector<x> j; \
for (const sensor_t& i : w) \
{ \
j.push_back(*((dynamic_cast<z*>(i.sensor))->k())); \
} \
return j; \
}
// Read a Vec3 value and multiply it by the sensor transform matrix
#define RVEC(x, y, k, z, w) \
vector<x> y() const \
{ \
vector<x> j; \
for (const sensor_t& i : w) \
{ \
x vec = *(i.transform) * *((dynamic_cast<z*>(i.sensor))->k()); \
j.push_back(vec); \
} \
return j; \
}
// clang-format off
RVEC(Vec3, getAccel, accelDataPtr, AccelSensor, accel)
RVEC(Vec3, getRotation, gyroDataPtr, GyroSensor, gyro)
RVEC(Vec3, getCompass, compassDataPtr, CompassSensor, compass)
RFLO(float, getTemperature, tempDataPtr, TemperatureSensor, temps)
RFLO(float, getHumidity, humidityDataPtr,HumiditySensor, humidity)
RFLO(float, getPressure, pressureDataPtr,PressureSensor, pressure)
// clang-format on
#undef RFLO
#undef RVEC
private:
DemoBoard()
{
static const float v_inemo[16] = {0, 1, 0, 0, -1, 0, 0, 0,
0, 0, 1, 0, 0, 0, 0, 1};
static const float v_mpu[16] = {-1, 0, 0, 0, 0, -1, 0, 0,
0, 0, 1, 0, 0, 0, 0, 1};
static const Mat4 idMat = Mat4();
static const Mat4 iNemoMat = Mat4(v_inemo);
static const Mat4 mpuMat = Mat4(v_mpu);
// ----- FXAS21102 -----
typedef FXAS21002<spiFXAS21002> fx_t;
fx_t* fx = new fx_t(fx_t::DPS500);
if (fx->init())
PP("FXAS21102", PUSH({fx, &idMat}, gyro));
else
printf("Cannot start FXAS21102\n");
// ----- iNEMO -----
typedef iNEMOLSM9DS0<spiLSM9DS0_G, spiLSM9DS0_A> pd_inemo_t;
pd_inemo_t* nemo =
new pd_inemo_t(pd_inemo_t::ACC_FS_2G, pd_inemo_t::GYRO_FS_245,
pd_inemo_t::COMPASS_FS_2);
if (nemo->init())
PP("iNemo", PUSH3({nemo, &iNemoMat}, accel, gyro, compass));
else
printf("Cannot start iNemo\n");
// ----- LPS331AP -----
typedef LPS331AP<spiLPS331AP> lps_t;
lps_t* lps = new lps_t(lps_t::SS_25HZ);
if (lps->init())
PP("LPS331AP", PUSH2({lps, &idMat}, pressure, temps));
else
printf("Cannot start LPS\n");
// ----- MAX21105 -----
typedef MAX21105<spiMAX21105> max21_t;
max21_t* max21 = new max21_t(max21_t::ACC_FS_2G, max21_t::GYRO_FS_500);
if (max21->init())
PP("MAX21105", PUSH3({max21, &idMat}, accel, gyro, temps));
else
printf("Cannot start MAX21105\n");
// ----- MPL3115 -----
sensors::sda::mode(Mode::ALTERNATE_OD);
sensors::sda::alternateFunction(4);
sensors::scl::mode(Mode::ALTERNATE_OD);
sensors::scl::alternateFunction(4);
typedef MPL3115<ProtocolI2C<miosix::I2C1Driver> > mpl_t;
mpl_t* mpl = new mpl_t();
if (mpl->init())
PP("MPL3115", PUSH2({mpl, &idMat}, pressure, temps));
else
printf("Cannot start MPL3115\n");
// ----- MPU9250 -----
typedef MPU9250<spiMPU9250> mpu_t;
mpu_t* mpu = new mpu_t(mpu_t::ACC_FS_2G, mpu_t::GYRO_FS_250);
if (mpu->init())
PP("MPU9250", PUSH3({mpu, &mpuMat}, accel, compass, temps));
else
printf("Cannot start MPU9250\n");
// ----- MS580301BA07 -----
typedef MS580301BA07<spiMS580301BA07> ms5_t;
ms5_t* ms5 = new ms5_t();
if (ms5->init())
PP("MS580301BA07", PUSH2({ms5, &idMat}, pressure, temps));
else
printf("Cannot start MS580\n");
// ----- Si7021 -----
typedef Si7021<ProtocolI2C<miosix::I2C1Driver> > si_t;
si_t* si = new si_t();
if (si->init())
PP("Si7021", PUSH2({si, &idMat}, humidity, temps));
else
printf("Cannot start Si7021\n");
printf("Loaded %d sensors\n", sensors.size());
printf(" + %d gyro sensors\n", gyro.size());
printf(" + %d accel sensors\n", accel.size());
printf(" + %d compass sensors\n", compass.size());
printf(" + %d temperature sensors\n", temps.size());
printf(" + %d humidity sensors\n", humidity.size());
printf(" + %d pressure sensors\n", pressure.size());
}
typedef struct
{
Sensor* sensor;
const Mat4* transform;
} sensor_t;
vector<sensor_t> sensors;
vector<sensor_t> accel;
vector<sensor_t> gyro;
vector<sensor_t> compass;
vector<sensor_t> temps;
vector<sensor_t> humidity;
vector<sensor_t> pressure;
#define sDemoBoard DemoBoard::getInstance()
};
Vec3 averageVec(const vector<Vec3>& in)
{
Vec3 out;
for (const Vec3& i : in)
out += i;
if (in.size() > 0)
out *= 1.0f / (float)in.size();
return out;
}
float averageFloat(const vector<float>& in)
{
float out = 0;
for (const float& i : in)
out += i;
if (in.size() > 0)
out *= 1.0f / (float)in.size();
return out;
}
template <uint32_t alpha>
class LowPassPolicy
{
protected:
static float process(uint16_t id, float in)
{
if (id >= storage.size())
storage.resize(id + 1, 0.0);
storage[id] += (alpha / 1000.0f) * (in - storage[id]);
return storage[id];
}
static vector<float> storage;
};
template <uint32_t beta>
class HighPassPolicy
{
protected:
static float process(uint16_t id, float in)
{
if (id >= storage.size())
{
storage.resize(id + 1, 0.0);
unfiltered.resize(id + 1, 0.0);
}
storage[id] = (beta / 1000.0f) * (storage[id] + in - unfiltered[id]);
unfiltered[id] = in;
return storage[id];
}
static vector<float> unfiltered;
static vector<float> storage;
};
template <typename FilterPolicy>
class BandFilter : private FilterPolicy
{
public:
/* For each call, increment id of 3 * data.size() to avoid overlapping */
static void process(uint16_t id, vector<Vec3>& data)
{
for (size_t i = 0; i < data.size(); i++)
process(id + i * 3, data[i]);
}
/* For each call, increment id of data.size() to avoid overlapping */
static void process(uint16_t id, vector<float>& data)
{
for (size_t i = 0; i < data.size(); i++)
FilterPolicy::process(id + i, data[i]);
}
static void printStorage()
{
printf("Lowpass: [");
for (const float& f : FilterPolicy::storage)
printf("%5.2f ", f);
printf("]\n");
}
static void process(uint16_t id, Vec3& data)
{
data.setX(FilterPolicy::process(id + 0, data.getX()));
data.setY(FilterPolicy::process(id + 1, data.getY()));
data.setZ(FilterPolicy::process(id + 2, data.getZ()));
}
};
template <uint32_t alpha>
vector<float> LowPassPolicy<alpha>::storage;
template <uint32_t beta>
vector<float> HighPassPolicy<beta>::storage;
template <uint32_t beta>
vector<float> HighPassPolicy<beta>::unfiltered;
#define VECARRAY_FILTER(id, array) \
do \
{ \
BandFilter<LowPassPolicy<lp_alpha> >::process(id, array); \
id += array.size() * 3; \
} while (0)
#define FLOATARRAY_FILTER(id, array) \
do \
{ \
BandFilter<LowPassPolicy<lp_alpha> >::process(id, array); \
id += array.size(); \
} while (0)
#define COPYVEC(arr, v) \
do \
{ \
arr[0] = v.getX(); \
arr[1] = v.getY(); \
arr[2] = v.getZ(); \
} while (0)
int main()
{
Thread::sleep(100);
sDemoBoard->init();
// Ethernet setup
#ifdef ENABLE_ETHERNET
const uint8_t ipAddr[] = {192, 168, 1, 30}; // Device's IP address
const uint8_t mask[] = {255, 255, 255, 0}; // Subnet mask
const uint8_t destIp[] = {192, 168, 1, 4}; // Destination IP address
const uint16_t destPort = 1234; // Destination port
printf("[Ethernet] Starting...\n");
W5200& eth = W5200::instance();
eth.setIpAddress(ipAddr);
eth.setSubnetMask(mask);
printf("[Ethernet] Got addr\n");
// This socket listens on UDP port 2020
// UdpManager::getInstance().setTxPort(2020);
printf("[Ethernet] Socket ready\n");
#endif
Vec3 orientation;
Vec3 angularvel;
int ignore_ctr = 100;
int led_status = 0x200;
while (1)
{
sDemoBoard->update();
Thread::sleep(20);
vector<Vec3> accels = sDemoBoard->getAccel();
vector<Vec3> rots = sDemoBoard->getRotation();
vector<Vec3> compsv = sDemoBoard->getCompass();
vector<float> temps = sDemoBoard->getTemperature();
vector<float> humid = sDemoBoard->getHumidity();
vector<float> press = sDemoBoard->getPressure();
uint16_t id = 0;
VECARRAY_FILTER(id, accels);
VECARRAY_FILTER(id, rots);
BandFilter<HighPassPolicy<hp_beta> >::process(0, rots);
VECARRAY_FILTER(id, compsv);
FLOATARRAY_FILTER(id, temps);
FLOATARRAY_FILTER(id, humid);
FLOATARRAY_FILTER(id, press);
Vec3 acc = averageVec(accels);
Vec3 rot = averageVec(rots);
Vec3 comps = averageVec(compsv);
float tempm = averageFloat(temps);
float humim = averageFloat(humid);
float presm = averageFloat(press);
pkt_t packet;
COPYVEC(packet.accel, acc);
COPYVEC(packet.gyro, rot);
COPYVEC(packet.compass, comps);
COPYVEC(packet.orientation, orientation);
packet.temperature = tempm;
packet.humidity = humim;
packet.pressure = presm;
Leds::set(led_status);
if (ignore_ctr == 0)
{
led_status <<= 1;
if (led_status == 0x400)
led_status = 0x04;
angularvel += rot * 0.2f;
orientation += angularvel * 0.2f;
BandFilter<HighPassPolicy<999> >::process(4, orientation);
}
else
{
led_status ^= 0x200;
--ignore_ctr;
if (ignore_ctr == 0)
led_status = 0x04;
}
#ifdef ENABLE_ETHERNET
sock.sendPacketTo(destIp, destPort, &packet, sizeof(packet));
#endif
printf(
"[%5.2f %5.2f %5.2f] "
"[%5.2f %5.2f %5.2f] "
"[%d %5.2f %5.2f %5.2f] "
"[%5.2f %5.2f %5.2f] "
"[%5.2f %5.2f %5.2f] \r",
acc.getX(), acc.getY(), acc.getZ(), rot.getX(), rot.getY(),
rot.getZ(), ignore_ctr, orientation.getX(), orientation.getY(),
orientation.getZ(), comps.getX(), comps.getY(), comps.getZ(), tempm,
humim, presm);
fflush(stdout);
}
// Bye.
while (1)
{
Thread::sleep(1000);
}
}
old_examples/entrypoints/anakin/anakin-test-dma.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2017 Skyward Experimental Rocketry
* Author: Alain Carlucci
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <boards/AnakinBoard.h>
#include <diagnostic/CpuMeter.h>
#include <diagnostic/Log.h>
#include <drivers/Leds.h>
using namespace miosix;
void fifoQueueSz(void* arg)
{
const SPIDriver& spi = SPIDriver::instance();
int tx_accum = 0, rx_accum = 0, sz_ctr = 0;
int qsize_accum = 0;
sLog->logString("Thread started");
while (1)
{
DMAFIFOStatus tx = spi.getTxFIFOStatus();
DMAFIFOStatus rx = spi.getRxFIFOStatus();
if (tx > -1 && rx > -1)
{
tx_accum += tx;
rx_accum += rx;
qsize_accum += sLog->getLogQueueSize();
if (++sz_ctr == 100)
{
float tx1 = tx_accum / (float)(DFS_100 - DFS_EE + 1) * 255.0f;
float rx1 = rx_accum / (float)(DFS_100 - DFS_EE + 1) * 255.0f;
float qsz = qsize_accum / 100.0f * 255.0f;
tx_accum = rx_accum = sz_ctr = qsize_accum = 0;
sLog->logLimitedInt(17, 0, 255, tx1);
sLog->logLimitedInt(18, 0, 255, rx1);
sLog->logUInt32(19, spi.getFIFOFaultCtr());
sLog->logUInt32(20, averageCpuUtilization());
sLog->logLimitedInt(21, 0, 255, qsz);
}
}
Thread::sleep(1);
}
}
int main()
{
sLog->start();
printf("\n");
Leds::set(0);
Log::getInstance();
sBoard->init();
const std::vector<SingleSensor>& data = sBoard->debugGetSensors();
int ctr = 0;
Thread::create(fifoQueueSz, 1024);
while (1)
{
for (const auto& s : data)
{
switch (s.data)
{
case DATA_VEC3:
sLog->logSensorVec3(s.sensor, *(Vec3*)s.value);
break;
case DATA_FLOAT:
sLog->logSensorFloat(s.sensor, *(float*)s.value);
break;
default:
break;
}
}
Thread::sleep(100);
}
return 0;
}
old_examples/entrypoints/anakin/anakin-test-suite.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Authors: Alain Carlucci, Matteo Piazzolla
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <drivers/BusTemplate.h>
#include <sensors/FXAS21002.h>
#include <sensors/MAX21105.h>
#include <sensors/MPU9250.h>
#include <sensors/MS580301BA07.h>
//#include <sensors/Si7021.h>
using namespace miosix;
#define SENSOR(NAME, CSPORT, CSPIN) \
typedef Gpio<GPIO##CSPORT##_BASE, CSPIN> CS_##NAME; \
typedef ProtocolSPI<busSPI1, CS_##NAME> spi##NAME
#define READ(NAME, ID) spi##NAME::read(ID)
#define TEST(NAME, REG, REF) test_and_print(#NAME, REG, READ(NAME, REG), REF)
#define ACCEL_ENDLESS_TEST
// SPI1
typedef Gpio<GPIOA_BASE, 5> GpioSck;
typedef Gpio<GPIOA_BASE, 6> GpioMiso;
typedef Gpio<GPIOA_BASE, 7> GpioMosi;
typedef BusSPI<1, GpioMosi, GpioMiso, GpioSck> busSPI1;
// clang-format off
// Here's the list of SPI sensors that should be tested
// | NAME | CSPORT | CSPIN |
SENSOR(MPU9250, D, 13);
SENSOR(FXAS21002, G, 10);
SENSOR(MAX21105, E, 2);
SENSOR(MAX31856, B, 11);
SENSOR(LSM9DS0_G, G, 9);
SENSOR(LSM9DS0_A, G, 11);
SENSOR(LPS331AP, E, 4);
SENSOR(MS580301BA07, B, 10);
// clang-format on
static const char mOK[] = "OK";
static const char mKO[] = "FAIL";
int num_ok = 0, num_fail = 0;
void banner()
{
printf(
"----------------------------------------------------------------------"
"------\n"
"d888888b d88888b .d8888. d888888b .d8888. db db d888888b d888888b "
"d88888b\n"
"`~~88~~' 88' 88' YP `~~88~~' 88' YP 88 88 `88' `~~88~~' "
"88' \n"
" 88 88ooooo `8bo. 88 `8bo. 88 88 88 88 "
"88ooooo\n"
" 88 88~~~~~ `Y8b. 88 `Y8b. 88 88 88 88 "
"88~~~~~\n"
" 88 88. db 8D 88 db 8D 88b d88 .88. 88 "
"88. \n"
" YP Y88888P `8888Y' YP `8888Y' ~Y8888P' Y888888P YP "
"Y88888P\n"
"----------------------------------------------------------------------"
"------\n"
"\n");
}
void test_and_print(const char* name, uint8_t reg, uint8_t test,
uint8_t reference)
{
if (test == reference)
++num_ok;
else
++num_fail;
printf("[%13s] [REG 0x%02x]: 0x%02x -> [%s]\n", name, reg, test,
(test == reference) ? mOK : mKO);
}
void assert_true(const char* name, const char* func, bool value)
{
if (value)
++num_ok;
else
++num_fail;
printf("[%13s] [FUNC %9s] -> [%s]\n", name, func, (value) ? mOK : mKO);
}
void test_max31856()
{
// Check if a bunch of register have the reference value
TEST(MAX31856, 0x00, 0x00); // config 0
TEST(MAX31856, 0x01, 0x03); // config 1
TEST(MAX31856, 0x02, 0xFF); // mask
TEST(MAX31856, 0x03, 0x7F); // hi fault
TEST(MAX31856, 0x04, 0xc0); // lo fault
TEST(MAX31856, 0x05, 0x7f); // lol
TEST(MAX31856, 0x0F, 0x00); // fault status reg
}
void test_altimeter()
{
MS580301BA07<spiMS580301BA07> altiMS580;
// Read and check different const registers
TEST(MS580301BA07, 0xA4, READ(MS580301BA07, 0xA4));
TEST(MS580301BA07, 0xAA, READ(MS580301BA07, 0xAA));
TEST(MS580301BA07, 0xAC, READ(MS580301BA07, 0xAC));
assert_true("MS580301BA07", "init()", altiMS580.init());
}
int main()
{
MAX21105<spiMAX21105> max21(MAX21105<spiMAX21105>::ACC_FS_2G,
MAX21105<spiMAX21105>::GYRO_FS_500);
banner();
// Pausa per lasciare il tempo ai sensori di accendersi
Thread::sleep(100);
printf("Polling sensors...\n");
// clang-format off
// First check: compare sensors WHO_AM_I against the reference value
TEST(MPU9250, 0x75, 0x71);
TEST(FXAS21002, 0x0c, 0xd7);
TEST(MAX21105, 0x20, 0xb4);
TEST(LSM9DS0_G, 0x0f, 0xd4);
TEST(LSM9DS0_A, 0x0f, 0x49);
TEST(LPS331AP, 0x0f, 0xBB);
// clang-format on
test_max31856();
test_altimeter();
assert_true("MAX21105", "init()", max21.init());
printf("---------------------\n");
printf(
"NUM TEST OK: %5d\n"
"NUM TEST FAIL:%5d\n\n",
num_ok, num_fail);
#ifdef ACCEL_ENDLESS_TEST
uint16_t cnt = 0;
const Vec3* a = max21.accelDataPtr();
const Vec3* g = max21.gyroDataPtr();
const float* temp = max21.tempDataPtr();
while (true)
{
max21.onSimpleUpdate();
printf(
"%05u[ACC %+5.2f,%+5.2f,%+5.2f] "
"[GYR %+5.2f,%+5.2f,%+5.2f] "
"[TMP %+5.2fC] \r",
(uint16_t)(++cnt), a->getX(), a->getY(), a->getZ(), g->getX(),
g->getY(), g->getZ(), *temp);
Thread::sleep(10);
}
#endif
// Bye.
while (1)
{
Thread::sleep(1000);
}
}
old_examples/entrypoints/anakin/canbus-test.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Authors: Alain Carlucci, Matteo Piazzolla
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <drivers/canbus/CanManager.h>
#include <drivers/canbus/CanSocket.h>
#include <drivers/canbus/CanUtils.h>
#include <sensors/MPU9250.h>
using namespace std;
using namespace miosix;
#define CAN_PACKETID 0x49
int main()
{
CanManager c(CAN1);
canbus_init_t st = {
CAN1, Mode::ALTERNATE, 9, {CAN1_RX0_IRQn, CAN1_RX1_IRQn}};
c.addBus<GPIOA_BASE, 11, 12>(st);
// canbus_init_t st2= {
// CAN2, Mode::ALTERNATE, 9, {CAN2_RX0_IRQn,CAN2_RX1_IRQn}
//};
// c.addBus<GPIOB_BASE, 5, 6>(st2);
CanBus *bus = c.getBus(0);
CanSocket socket(CAN_PACKETID);
char buf[64] = {0};
socket.open(bus);
printf("*** Ready ***\n");
while (1)
{
const char *pkt = "TestMSG";
bus->send(CAN_PACKETID, (const uint8_t *)pkt, strlen(pkt));
socket.receive(buf, 64);
printf("Recv pkt: '%s'\n", buf);
Thread::sleep(250);
}
socket.close();
}
old_examples/entrypoints/anakin/dma-lowlevel-test.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2017 Skyward Experimental Rocketry
* Author: Federico Terraneo
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <drivers/spi/SensorSpi.h>
#include <sensors/FXAS21002.h>
#include <sensors/LPS331AP.h>
#include <sensors/MAX21105.h>
#include <sensors/MPU9250.h>
#include <sensors/MS580301BA07.h>
#include <sensors/SensorSampling.h>
#include <sensors/iNemo.h>
using namespace miosix;
typedef Gpio<GPIOA_BASE, 5> GpioSck;
typedef Gpio<GPIOA_BASE, 6> GpioMiso;
typedef Gpio<GPIOA_BASE, 7> GpioMosi;
typedef BusSPI<1, GpioMosi, GpioMiso, GpioSck> busSPI1;
typedef ProtocolSPI<busSPI1, Gpio<GPIOD_BASE, 13>> spiMPU9250;
typedef ProtocolSPI<busSPI1, Gpio<GPIOG_BASE, 11>> spiINEMOA;
typedef ProtocolSPI<busSPI1, Gpio<GPIOG_BASE, 9>> spiINEMOG;
typedef MPU9250<spiMPU9250> mpu_t;
typedef iNEMOLSM9DS0<spiINEMOG, spiINEMOA> inemo_t;
int main()
{
puts("\n\n---");
spiMPU9250::init();
spiINEMOA::init();
spiINEMOG::init();
auto& spi = SPIDriver::instance();
inemo_t inemo(inemo_t::ACC_FS_16G, inemo_t::GYRO_FS_245,
inemo_t::COMPASS_FS_2);
if (inemo.init() == false)
{
puts("init failed");
}
auto req = inemo.buildDMARequest();
auto sample = [&]()
{
if (spi.transaction(req) == false)
puts("DMA error");
for (auto& r : req)
{
inemo.onDMAUpdate(r);
printf("ID: %d --> ", r.id());
auto& resp = r.readResponseFromPeripheral();
memDump(resp.data(), resp.size());
}
};
for (int i = 0; i < 2; i++)
{
Thread::sleep(20);
sample();
}
for (;;)
{
getchar();
sample();
}
}
old_examples/entrypoints/anakin/test-scheduler.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Authors: Matteo Piazzolla, Federico Terraneo
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <drivers/BusTemplate.h>
#include <drivers/stm32f2_f4_i2c.h>
#include <events/Scheduler.h>
using namespace miosix;
template <typename P, unsigned N>
void blinker()
{
if (P::value())
P::low();
else
P::high();
delayMs(2);
}
int main()
{
sEventScheduler->start();
// Thread *ledTh=Thread::create(supercar,STACK_MIN);
sEventScheduler->add(blinker<leds::led9, 100>, 100, "task100");
sEventScheduler->add(blinker<leds::led8, 200>, 200, "task200");
sEventScheduler->add(blinker<leds::led7, 500>, 500, "task500");
sEventScheduler->add(blinker<leds::led6, 1000>, 1000, "task1000");
sEventScheduler->add(blinker<leds::led5, 50>, 50, "task50");
for (;;)
{
Thread::sleep(1000);
auto result = sEventScheduler->getTaskStats();
printf("--- begin ---\n");
printf("%u tasks\n", result.size());
for (auto& it : result)
printf("Name: %s\n", it.name.c_str());
printf("--- end ---\n");
}
}
old_examples/entrypoints/anakin/test_ethernet.cpp deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Author: Silvano Seva
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#include <Common.h>
#include <drivers/ethernet/UdpManager.h>
#include <string>
using namespace miosix;
using namespace std;
int main()
{
uint8_t ipAddr[] = {192, 168, 1, 30}; // Device's IP address
uint8_t mask[] = {255, 255, 255, 0}; // Subnet mask
uint8_t destIp[] = {192, 168, 1, 180}; // Destination IP address
char message[] = "message from the hell...\n";
W5200& eth = W5200::instance();
eth.setIpAddress(ipAddr);
eth.setSubnetMask(mask);
auto udp = Singleton<UdpManager>::getInstance();
udp->setTxPort(1234);
udp->setRxPort(1235);
int counter = 0;
while (1)
{
int ncar = sprintf(message, "Hello gumby n° %d!\n", counter);
udp->sendPacketTo(destIp, 2020, (void*)message, ncar);
counter++;
if (udp->newReceivedPackets())
{
size_t pktSiz = udp->recvPacketSize() + 1;
uint8_t buffer[pktSiz];
memset(buffer, 0x00, pktSiz);
uint8_t sip[4] = {0};
uint16_t sport = 0;
udp->readPacket(sip, sport, buffer);
printf("received %s from %d.%d.%d.%d:%d\n\n", buffer, sip[0],
sip[1], sip[2], sip[3], sport);
}
Thread::sleep(200);
}
return 0;
}
old_examples/shared/Common.h deleted 100644 → 0
View file @ 9c4cd6d0
/* Copyright (c) 2015-2016 Skyward Experimental Rocketry
* Author: Alain Carlucci
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in
* all copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
* THE SOFTWARE.
*/
#pragma once
#include <drivers/timer/TimestampTimer.h>
#include <interfaces/endianness.h>
#include <kernel/scheduler/scheduler.h>
#include <miosix.h>
#include <pthread.h>
#include <utils/Constants.h>
#include <utils/Debug.h>
#include <array>
#include <cassert>
#include <cstdint>
#include <cstdio>
#include <cstring>
#include <map>
#include <memory>
#include <set>
#include <vector>
#define UNUSED(x) (void)(x)