diff options
Diffstat (limited to '60xx/libsensors_iio/software/core/mllite/linux')
8 files changed, 0 insertions, 1466 deletions
diff --git a/60xx/libsensors_iio/software/core/mllite/linux/ml_load_dmp.c b/60xx/libsensors_iio/software/core/mllite/linux/ml_load_dmp.c deleted file mode 100644 index 72940f7..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/ml_load_dmp.c +++ /dev/null @@ -1,279 +0,0 @@ -/* - $License: - Copyright (C) 2012 InvenSense Corporation, All Rights Reserved. - $ - */ - -/****************************************************************************** - * - * $Id:$ - * - *****************************************************************************/ - -/** - * @defgroup ML_LOAD_DMP - * - * @{ - * @file ml_load_dmp.c - * @brief functions for writing dmp firmware. - */ -#include <stdio.h> - -#include "log.h" -#undef MPL_LOG_TAG -#define MPL_LOG_TAG "MPL-loaddmp" - -#include "ml_load_dmp.h" -#include "mlos.h" - -#define LOADDMP_LOG MPL_LOGI -#define LOADDMP_LOG MPL_LOGI - -#define NUM_LOCAL_KEYS (sizeof(dmpTConfig)/sizeof(dmpTConfig[0])) -#define DMP_CODE_SIZE 3065 - -static const unsigned char dmpMemory[DMP_CODE_SIZE] = { - /* bank # 0 */ - 0x00, 0x00, 0x70, 0x00, 0x00, 0x00, 0x00, 0x24, 0x00, 0x00, 0x00, 0x02, 0x00, 0x03, 0x00, 0x00, - 0x00, 0x65, 0x00, 0x54, 0xff, 0xef, 0x00, 0x00, 0xfa, 0x80, 0x00, 0x0b, 0x12, 0x82, 0x00, 0x01, - 0x03, 0x0c, 0x30, 0xc3, 0x0e, 0x8c, 0x8c, 0xe9, 0x14, 0xd5, 0x40, 0x02, 0x13, 0x71, 0x0f, 0x8e, - 0x38, 0x83, 0xf8, 0x83, 0x30, 0x00, 0xf8, 0x83, 0x25, 0x8e, 0xf8, 0x83, 0x30, 0x00, 0xf8, 0x83, - 0x00, 0x00, 0x00, 0x01, 0x0f, 0xfe, 0xa9, 0xd6, 0x24, 0x00, 0x04, 0x00, 0x1a, 0x82, 0x79, 0xa1, - 0xff, 0xff, 0x00, 0x00, 0x00, 0x14, 0x00, 0x00, 0x00, 0x10, 0x00, 0x00, 0x00, 0x12, 0x00, 0x02, - 0x00, 0x3e, 0x03, 0x30, 0x40, 0x00, 0x00, 0x00, 0x02, 0xca, 0xe3, 0x09, 0x3e, 0x80, 0x00, 0x00, - 0x20, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x60, 0x00, 0x00, 0x00, - 0x00, 0x0c, 0x00, 0x00, 0x00, 0x0c, 0x18, 0x6e, 0x00, 0x00, 0x06, 0x92, 0x0a, 0x16, 0xc0, 0xdf, - 0xff, 0xff, 0x02, 0x56, 0xfd, 0x8c, 0xd3, 0x77, 0xff, 0xe1, 0xc4, 0x96, 0xe0, 0xc5, 0xbe, 0xaa, - 0x00, 0x00, 0x00, 0x00, 0xff, 0xff, 0x0b, 0x2b, 0x00, 0x00, 0x16, 0x57, 0x00, 0x00, 0x03, 0x59, - 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x1d, 0xfa, 0x00, 0x02, 0x6c, 0x1d, 0x00, 0x00, 0x00, 0x00, - 0x3f, 0xff, 0xdf, 0xeb, 0x00, 0x3e, 0xb3, 0xb6, 0x00, 0x0d, 0x22, 0x78, 0x00, 0x00, 0x2f, 0x3c, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x19, 0x42, 0xb5, 0x00, 0x00, 0x39, 0xa2, 0x00, 0x00, 0xb3, 0x65, - 0x3f, 0x84, 0x05, 0x99, 0xf2, 0xbc, 0x3a, 0x39, 0xf1, 0x53, 0x7a, 0x76, 0xd9, 0x0e, 0x9f, 0xc8, - 0x00, 0x00, 0x00, 0x00, 0xf2, 0xbc, 0x3a, 0x39, 0xf1, 0x53, 0x7a, 0x76, 0xd9, 0x0e, 0x9f, 0xc8, - /* bank # 1 */ - 0x10, 0x00, 0x00, 0x00, 0x10, 0x00, 0xfa, 0x92, 0x10, 0x00, 0x22, 0x5e, 0x00, 0x0d, 0x22, 0x9f, - 0x00, 0x01, 0x00, 0x00, 0x00, 0x32, 0x00, 0x00, 0xff, 0x46, 0x00, 0x00, 0x63, 0xd4, 0x00, 0x00, - 0x10, 0x00, 0x00, 0x00, 0x04, 0xd6, 0x00, 0x00, 0x04, 0xcc, 0x00, 0x00, 0x04, 0xcc, 0x00, 0x00, - 0x00, 0x00, 0x10, 0x72, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x06, 0x00, 0x02, 0x00, 0x05, 0x00, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, 0x64, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x05, 0x00, 0x05, 0x00, 0x64, 0x00, 0x20, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x40, 0x00, 0x00, 0x00, 0x03, 0x00, - 0x00, 0x00, 0x00, 0x32, 0xf8, 0x98, 0x00, 0x00, 0xff, 0x65, 0x00, 0x00, 0x83, 0x0f, 0x00, 0x00, - 0xff, 0x9b, 0xfc, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, - 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x00, 0x00, 0xb2, 0x6a, 0x00, 0x02, 0x00, 0x00, - 0x00, 0x01, 0xfb, 0x83, 0x00, 0x68, 0x00, 0x00, 0x00, 0xd9, 0xfc, 0x00, 0x7c, 0xf1, 0xff, 0x83, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x65, 0x00, 0x00, 0x00, 0x64, 0x03, 0xe8, 0x00, 0x64, 0x00, 0x28, - 0x00, 0x00, 0x00, 0x25, 0x00, 0x00, 0x00, 0x00, 0x16, 0xa0, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00, - 0x00, 0x00, 0x10, 0x00, 0x00, 0x2f, 0x00, 0x00, 0x00, 0x00, 0x01, 0xf4, 0x00, 0x00, 0x10, 0x00, - /* bank # 2 */ - 0x00, 0x28, 0x00, 0x00, 0xff, 0xff, 0x45, 0x81, 0xff, 0xff, 0xfa, 0x72, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x44, 0x00, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x00, 0x00, 0x00, 0x00, 0x14, - 0x00, 0x00, 0x25, 0x4d, 0x00, 0x2f, 0x70, 0x6d, 0x00, 0x00, 0x05, 0xae, 0x00, 0x0c, 0x02, 0xd0, - 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x1b, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x47, 0x78, 0xa2, - 0x00, 0x1b, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x0e, 0x00, 0x0e, - 0x00, 0x00, 0x0a, 0xc7, 0x00, 0x04, 0x00, 0x00, 0x00, 0x00, 0x00, 0x32, 0xff, 0xff, 0xff, 0x9c, - 0x00, 0x00, 0x0b, 0x2b, 0x00, 0x00, 0x00, 0x02, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x64, - 0xff, 0xe5, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - /* bank # 3 */ - 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x01, 0x80, 0x00, 0x00, 0x24, 0x26, 0xd3, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x06, 0x00, 0x10, 0x00, 0x96, 0x00, 0x3c, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x0c, 0x0a, 0x4e, 0x68, 0xcd, 0xcf, 0x77, 0x09, 0x50, 0x16, 0x67, 0x59, 0xc6, 0x19, 0xce, 0x82, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x17, 0xd7, 0x84, 0x00, 0x03, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xc7, 0x93, 0x8f, 0x9d, 0x1e, 0x1b, 0x1c, 0x19, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x02, 0x03, 0x18, 0x85, 0x00, 0x00, 0x40, 0x00, - 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x40, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - 0x00, 0x00, 0x00, 0x00, 0x67, 0x7d, 0xdf, 0x7e, 0x72, 0x90, 0x2e, 0x55, 0x4c, 0xf6, 0xe6, 0x88, - 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, - - /* bank # 4 */ - 0xd8, 0xdc, 0xb4, 0xb8, 0xb0, 0xd8, 0xb9, 0xab, 0xf3, 0xf8, 0xfa, 0xb3, 0xb7, 0xbb, 0x8e, 0x9e, - 0xae, 0xf1, 0x32, 0xf5, 0x1b, 0xf1, 0xb4, 0xb8, 0xb0, 0x80, 0x97, 0xf1, 0xa9, 0xdf, 0xdf, 0xdf, - 0xaa, 0xdf, 0xdf, 0xdf, 0xf2, 0xaa, 0xc5, 0xcd, 0xc7, 0xa9, 0x0c, 0xc9, 0x2c, 0x97, 0x97, 0x97, - 0x97, 0xf1, 0xa9, 0x89, 0x26, 0x46, 0x66, 0xb2, 0x89, 0x99, 0xa9, 0x2d, 0x55, 0x7d, 0xb0, 0x99, - 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, 0x99, - 0x99, 0x99, 0xb0, 0x8a, 0xa8, 0x96, 0x36, 0x56, 0x76, 0xf1, 0xba, 0xa3, 0xb4, 0xb2, 0x80, 0xc0, - 0xb8, 0xa8, 0x97, 0x11, 0xb2, 0x83, 0x98, 0xba, 0xa3, 0xf0, 0x24, 0x08, 0x44, 0x10, 0x64, 0x18, - 0xb2, 0xb9, 0xb4, 0x98, 0x83, 0xf1, 0xa3, 0x29, 0x55, 0x7d, 0xba, 0xb5, 0xb1, 0xa3, 0x83, 0x93, - 0xf0, 0x00, 0x28, 0x50, 0xf5, 0xb2, 0xb6, 0xaa, 0x83, 0x93, 0x28, 0x54, 0x7c, 0xb9, 0xf1, 0xa3, - 0x82, 0x93, 0x61, 0xba, 0xa2, 0xda, 0xde, 0xdf, 0xdb, 0x8b, 0x9a, 0xb9, 0xae, 0xf5, 0x60, 0x68, - 0x70, 0xf1, 0xda, 0xba, 0xa2, 0xdf, 0xd9, 0xa2, 0xfa, 0xb9, 0xa3, 0x82, 0x92, 0xdb, 0x31, 0xba, - 0xa2, 0xd9, 0xf8, 0xdf, 0xa4, 0x83, 0xc2, 0xc5, 0xc7, 0x85, 0xc1, 0xb8, 0xa2, 0xdf, 0xdf, 0xdf, - 0xba, 0xa0, 0xdf, 0xdf, 0xdf, 0xd8, 0xd8, 0xf1, 0xb8, 0xa8, 0xb3, 0x8d, 0xb4, 0x98, 0x0d, 0x35, - 0x5d, 0xb8, 0xaa, 0x98, 0xb0, 0x87, 0x2d, 0x35, 0x3d, 0xb2, 0xb6, 0xba, 0xaf, 0x8c, 0x96, 0x19, - 0x8f, 0x9f, 0xa7, 0x0e, 0x16, 0x1e, 0xb4, 0x9a, 0xb8, 0xaa, 0x87, 0x2c, 0x54, 0x7c, 0xd8, 0xb8, - 0xb4, 0xb0, 0xf1, 0x99, 0x82, 0xa8, 0x2d, 0x55, 0x7d, 0x98, 0xa8, 0x0e, 0x16, 0x1e, 0xa2, 0x2c, - /* bank # 5 */ - 0x54, 0x7c, 0xa8, 0x92, 0xf5, 0x2c, 0x54, 0x88, 0x98, 0xf1, 0x35, 0xd9, 0xf4, 0x18, 0xd8, 0xf1, - 0xa2, 0xd0, 0xf8, 0xf9, 0xa8, 0x84, 0xd9, 0xc7, 0xdf, 0xf8, 0xf8, 0x83, 0xc5, 0xda, 0xdf, 0x69, - 0xdf, 0x83, 0xc1, 0xd8, 0xf4, 0x01, 0x14, 0xf1, 0xa8, 0x82, 0x4e, 0xa8, 0x84, 0xf3, 0x11, 0xd1, - 0x82, 0xf5, 0xd9, 0x92, 0x28, 0x97, 0x88, 0xf1, 0x09, 0xf4, 0x1c, 0x1c, 0xd8, 0x84, 0xa8, 0xf3, - 0xc0, 0xf9, 0xd1, 0xd9, 0x97, 0x82, 0xf1, 0x29, 0xf4, 0x0d, 0xd8, 0xf3, 0xf9, 0xf9, 0xd1, 0xd9, - 0x82, 0xf4, 0xc2, 0x03, 0xd8, 0xde, 0xdf, 0x1a, 0xd8, 0xf1, 0xa2, 0xfa, 0xf9, 0xa8, 0x84, 0x98, - 0xd9, 0xc7, 0xdf, 0xf8, 0xf8, 0xf8, 0x83, 0xc7, 0xda, 0xdf, 0x69, 0xdf, 0xf8, 0x83, 0xc3, 0xd8, - 0xf4, 0x01, 0x14, 0xf1, 0x98, 0xa8, 0x82, 0x2e, 0xa8, 0x84, 0xf3, 0x11, 0xd1, 0x82, 0xf5, 0xd9, - 0x92, 0x50, 0x97, 0x88, 0xf1, 0x09, 0xf4, 0x1c, 0xd8, 0x84, 0xa8, 0xf3, 0xc0, 0xf8, 0xf9, 0xd1, - 0xd9, 0x97, 0x82, 0xf1, 0x49, 0xf4, 0x0d, 0xd8, 0xf3, 0xf9, 0xf9, 0xd1, 0xd9, 0x82, 0xf4, 0xc4, - 0x03, 0xd8, 0xde, 0xdf, 0xd8, 0xf1, 0xad, 0x88, 0x98, 0xcc, 0xa8, 0x09, 0xf9, 0xd9, 0x82, 0x92, - 0xa4, 0xf0, 0x2c, 0x50, 0x78, 0xa8, 0x82, 0xf5, 0x7c, 0xf1, 0x88, 0x3a, 0xcf, 0x94, 0x4a, 0x6e, - 0x98, 0xdb, 0x69, 0x31, 0xd9, 0x84, 0xc4, 0xcd, 0xfc, 0xdb, 0x6d, 0xd9, 0xa8, 0xfc, 0xdb, 0x25, - 0xda, 0xad, 0xf2, 0xde, 0xf9, 0xd8, 0xf2, 0xa5, 0xf8, 0x8d, 0x94, 0xd1, 0xda, 0xf4, 0x19, 0xd8, - 0xa8, 0xf2, 0x05, 0xd1, 0xa4, 0xda, 0xc0, 0xa5, 0xf7, 0xde, 0xf9, 0xd8, 0xa5, 0xf8, 0x85, 0x95, - 0x18, 0xdf, 0xf1, 0xad, 0x8e, 0xc3, 0xc5, 0xc7, 0xd8, 0xf2, 0xa5, 0xf8, 0xd1, 0xd9, 0xf1, 0xad, - /* bank # 6 */ - 0x8f, 0xc3, 0xc5, 0xc7, 0xd8, 0xa5, 0xf2, 0xf9, 0xf9, 0xa8, 0x8d, 0x9d, 0xf0, 0x28, 0x50, 0x78, - 0x84, 0x98, 0xf1, 0x26, 0x84, 0x95, 0x2d, 0x88, 0x98, 0x11, 0x52, 0x87, 0x12, 0x12, 0x88, 0x31, - 0xf9, 0xd9, 0xf1, 0x8d, 0x9d, 0x7a, 0xf5, 0x7c, 0xf1, 0x88, 0x7a, 0x98, 0x45, 0x8e, 0x0e, 0xf5, - 0x82, 0x92, 0x7c, 0x88, 0xf1, 0x5a, 0x98, 0x5a, 0x82, 0x92, 0x7e, 0x88, 0x94, 0x69, 0x98, 0x1e, - 0x11, 0x08, 0xd0, 0xf5, 0x04, 0xf1, 0x1e, 0x97, 0x02, 0x02, 0x98, 0x36, 0x25, 0xdb, 0xf9, 0xd9, - 0xf0, 0x8d, 0x92, 0xa8, 0x49, 0x30, 0x2c, 0x50, 0x8e, 0xc9, 0x88, 0x98, 0x34, 0xf5, 0x04, 0xf1, - 0x61, 0xdb, 0xf9, 0xd9, 0xf2, 0xa5, 0xf8, 0xdb, 0xf9, 0xd9, 0xf3, 0xfa, 0xd8, 0xf2, 0xa5, 0xf8, - 0xf9, 0xd9, 0xf1, 0xaf, 0x8e, 0xc3, 0xc5, 0xc7, 0xae, 0x82, 0xc3, 0xc5, 0xc7, 0xd8, 0xa4, 0xf2, - 0xf8, 0xd1, 0xa5, 0xf3, 0xd9, 0xde, 0xf9, 0xdf, 0xd8, 0xa4, 0xf2, 0xf9, 0xa5, 0xf8, 0xf8, 0xd1, - 0xda, 0xf9, 0xf9, 0xf4, 0x18, 0xd8, 0xf2, 0xf9, 0xf9, 0xf3, 0xfb, 0xf9, 0xd1, 0xda, 0xf4, 0x1d, - 0xd9, 0xf3, 0xa4, 0x84, 0xc8, 0xa8, 0x9f, 0x01, 0xdb, 0xd1, 0xd8, 0xf4, 0x10, 0x1c, 0xd8, 0xbb, - 0xaf, 0xd0, 0xf2, 0xde, 0xf8, 0xf8, 0xf8, 0xf8, 0xf8, 0xf8, 0xf8, 0xf8, 0xb8, 0xd8, 0xf3, 0xaf, - 0x84, 0xc0, 0xa5, 0xfa, 0xf8, 0xf2, 0x85, 0xa5, 0xc6, 0xd8, 0xd8, 0xf2, 0xf9, 0xf6, 0xb5, 0xb9, - 0xb0, 0x8a, 0x95, 0xa3, 0xde, 0x3c, 0xa3, 0xd9, 0xf8, 0xd8, 0x5c, 0xa3, 0xd9, 0xf8, 0xd8, 0x7c, - 0xa3, 0xd9, 0xf8, 0xd8, 0xf8, 0xf9, 0xd1, 0xa5, 0xd9, 0xdf, 0xda, 0xfa, 0xd8, 0xb1, 0x85, 0x30, - 0xf7, 0xd9, 0xde, 0xd8, 0xf8, 0x30, 0xad, 0xda, 0xde, 0xd8, 0xf2, 0xb4, 0x8c, 0x99, 0xa3, 0x2d, - /* bank # 7 */ - 0x55, 0x7d, 0xa0, 0x83, 0xdf, 0xdf, 0xdf, 0xb5, 0x91, 0xa0, 0xf6, 0x29, 0xd9, 0xfb, 0xd8, 0xa0, - 0xfc, 0x29, 0xd9, 0xfa, 0xd8, 0xa0, 0xd0, 0x51, 0xd9, 0xf8, 0xd8, 0xfc, 0x51, 0xd9, 0xf9, 0xd8, - 0x79, 0xd9, 0xfb, 0xd8, 0xa0, 0xd0, 0xfc, 0x79, 0xd9, 0xfa, 0xd8, 0xa1, 0xf9, 0xf9, 0xf9, 0xf9, - 0xf9, 0xa0, 0xda, 0xdf, 0xdf, 0xdf, 0xd8, 0xa1, 0xf8, 0xf8, 0xf8, 0xf8, 0xf8, 0xac, 0xde, 0xf8, - 0xad, 0xde, 0x83, 0x93, 0xac, 0x2c, 0x54, 0x7c, 0xf1, 0xa8, 0xdf, 0xdf, 0xdf, 0xf6, 0x9d, 0x2c, - 0xda, 0xa0, 0xdf, 0xd9, 0xfa, 0xdb, 0x2d, 0xf8, 0xd8, 0xa8, 0x50, 0xda, 0xa0, 0xd0, 0xde, 0xd9, - 0xd0, 0xf8, 0xf8, 0xf8, 0xdb, 0x55, 0xf8, 0xd8, 0xa8, 0x78, 0xda, 0xa0, 0xd0, 0xdf, 0xd9, 0xd0, - 0xfa, 0xf8, 0xf8, 0xf8, 0xf8, 0xdb, 0x7d, 0xf8, 0xd8, 0x9c, 0xa8, 0x8c, 0xf5, 0x30, 0xdb, 0x38, - 0xd9, 0xd0, 0xde, 0xdf, 0xa0, 0xd0, 0xde, 0xdf, 0xd8, 0xa8, 0x48, 0xdb, 0x58, 0xd9, 0xdf, 0xd0, - 0xde, 0xa0, 0xdf, 0xd0, 0xde, 0xd8, 0xa8, 0x68, 0xdb, 0x70, 0xd9, 0xdf, 0xdf, 0xa0, 0xdf, 0xdf, - 0xd8, 0xf1, 0xa8, 0x88, 0x90, 0x2c, 0x54, 0x7c, 0x98, 0xa8, 0xd0, 0x5c, 0x38, 0xd1, 0xda, 0xf2, - 0xae, 0x8c, 0xdf, 0xf9, 0xd8, 0xb0, 0x87, 0xa8, 0xc1, 0xc1, 0xb1, 0x88, 0xa8, 0xc6, 0xf9, 0xf9, - 0xda, 0x36, 0xd8, 0xa8, 0xf9, 0xda, 0x36, 0xd8, 0xa8, 0xf9, 0xda, 0x36, 0xd8, 0xa8, 0xf9, 0xda, - 0x36, 0xd8, 0xa8, 0xf9, 0xda, 0x36, 0xd8, 0xf7, 0x8d, 0x9d, 0xad, 0xf8, 0x18, 0xda, 0xf2, 0xae, - 0xdf, 0xd8, 0xf7, 0xad, 0xfa, 0x30, 0xd9, 0xa4, 0xde, 0xf9, 0xd8, 0xf2, 0xae, 0xde, 0xfa, 0xf9, - 0x83, 0xa7, 0xd9, 0xc3, 0xc5, 0xc7, 0xf1, 0x88, 0x9b, 0xa7, 0x7a, 0xad, 0xf7, 0xde, 0xdf, 0xa4, - /* bank # 8 */ - 0xf8, 0x84, 0x94, 0x08, 0xa7, 0x97, 0xf3, 0x00, 0xae, 0xf2, 0x98, 0x19, 0xa4, 0x88, 0xc6, 0xa3, - 0x94, 0x88, 0xf6, 0x32, 0xdf, 0xf2, 0x83, 0x93, 0xdb, 0x09, 0xd9, 0xf2, 0xaa, 0xdf, 0xd8, 0xd8, - 0xae, 0xf8, 0xf9, 0xd1, 0xda, 0xf3, 0xa4, 0xde, 0xa7, 0xf1, 0x88, 0x9b, 0x7a, 0xd8, 0xf3, 0x84, - 0x94, 0xae, 0x19, 0xf9, 0xda, 0xaa, 0xf1, 0xdf, 0xd8, 0xa8, 0x81, 0xc0, 0xc3, 0xc5, 0xc7, 0xa3, - 0x92, 0x83, 0xf6, 0x28, 0xad, 0xde, 0xd9, 0xf8, 0xd8, 0xa3, 0x50, 0xad, 0xd9, 0xf8, 0xd8, 0xa3, - 0x78, 0xad, 0xd9, 0xf8, 0xd8, 0xf8, 0xf9, 0xd1, 0xa1, 0xda, 0xde, 0xc3, 0xc5, 0xc7, 0xd8, 0xa1, - 0x81, 0x94, 0xf8, 0x18, 0xf2, 0xb0, 0x89, 0xac, 0xc3, 0xc5, 0xc7, 0xf1, 0xd8, 0xb8, 0xb4, 0xb0, - 0x97, 0x86, 0xa8, 0x31, 0x9b, 0x06, 0x99, 0x07, 0xab, 0x97, 0x28, 0x88, 0x9b, 0xf0, 0x0c, 0x20, - 0x14, 0x40, 0xb0, 0xb4, 0xb8, 0xf0, 0xa8, 0x8a, 0x9a, 0x28, 0x50, 0x78, 0xb7, 0x9b, 0xa8, 0x29, - 0x51, 0x79, 0x24, 0x70, 0x59, 0x44, 0x69, 0x38, 0x64, 0x48, 0x31, 0xf1, 0xbb, 0xab, 0x88, 0x00, - 0x2c, 0x54, 0x7c, 0xf0, 0xb3, 0x8b, 0xb8, 0xa8, 0x04, 0x28, 0x50, 0x78, 0xf1, 0xb0, 0x88, 0xb4, - 0x97, 0x26, 0xa8, 0x59, 0x98, 0xbb, 0xab, 0xb3, 0x8b, 0x02, 0x26, 0x46, 0x66, 0xb0, 0xb8, 0xf0, - 0x8a, 0x9c, 0xa8, 0x29, 0x51, 0x79, 0x8b, 0x29, 0x51, 0x79, 0x8a, 0x24, 0x70, 0x59, 0x8b, 0x20, - 0x58, 0x71, 0x8a, 0x44, 0x69, 0x38, 0x8b, 0x39, 0x40, 0x68, 0x8a, 0x64, 0x48, 0x31, 0x8b, 0x30, - 0x49, 0x60, 0x88, 0xf1, 0xac, 0x00, 0x2c, 0x54, 0x7c, 0xf0, 0x8c, 0xa8, 0x04, 0x28, 0x50, 0x78, - 0xf1, 0x88, 0x97, 0x26, 0xa8, 0x59, 0x98, 0xac, 0x8c, 0x02, 0x26, 0x46, 0x66, 0xf0, 0x89, 0x9c, - /* bank # 9 */ - 0xa8, 0x29, 0x51, 0x79, 0x24, 0x70, 0x59, 0x44, 0x69, 0x38, 0x64, 0x48, 0x31, 0xa9, 0x88, 0x09, - 0x20, 0x59, 0x70, 0xab, 0x11, 0x38, 0x40, 0x69, 0xa8, 0x19, 0x31, 0x48, 0x60, 0x8c, 0xa8, 0x3c, - 0x41, 0x5c, 0x20, 0x7c, 0x00, 0xf1, 0x87, 0x98, 0x19, 0x86, 0xa8, 0x6e, 0x76, 0x7e, 0xa9, 0x99, - 0x88, 0x2d, 0x55, 0x7d, 0xf5, 0xb0, 0xb4, 0xb8, 0x88, 0x98, 0xad, 0x2c, 0x54, 0x7c, 0xb5, 0xb9, - 0x9e, 0xa3, 0xdf, 0xdf, 0xdf, 0xf6, 0xa3, 0x30, 0xd9, 0xfa, 0xdb, 0x35, 0xf8, 0xd8, 0xa3, 0x50, - 0xd0, 0xd9, 0xf8, 0xdb, 0x55, 0xf8, 0xd8, 0xa3, 0x70, 0xd0, 0xd9, 0xfa, 0xdb, 0x75, 0xf8, 0xd8, - 0xa3, 0xb4, 0x8d, 0x9d, 0x30, 0xdb, 0x38, 0xd9, 0xd0, 0xde, 0xdf, 0xd8, 0xa3, 0x48, 0xdb, 0x58, - 0xd9, 0xdf, 0xd0, 0xde, 0xd8, 0xa3, 0x68, 0xdb, 0x70, 0xd9, 0xdf, 0xdf, 0xd8, 0xf1, 0xa3, 0xb1, - 0xb5, 0x82, 0xc0, 0x83, 0x93, 0x0e, 0x0a, 0x0a, 0x16, 0x12, 0x1e, 0x58, 0x38, 0x1a, 0xa3, 0x8f, - 0x7c, 0x83, 0x0e, 0xa3, 0x12, 0x86, 0x61, 0xd1, 0xd9, 0xc7, 0xc7, 0xd8, 0xa3, 0x6d, 0xd1, 0xd9, - 0xc7, 0xd8, 0xa3, 0x71, 0xd1, 0xa6, 0xd9, 0xc5, 0xda, 0xdf, 0xd8, 0x9f, 0x83, 0xf3, 0xa3, 0x65, - 0xd1, 0xaf, 0xc6, 0xd9, 0xfa, 0xda, 0xdf, 0xd8, 0xa3, 0x8f, 0xdf, 0x1d, 0xd1, 0xa3, 0xd9, 0xfa, - 0xd8, 0xa3, 0x31, 0xda, 0xfa, 0xd9, 0xaf, 0xdf, 0xd8, 0xa3, 0xfa, 0xf9, 0xd1, 0xd9, 0xaf, 0xd0, - 0x96, 0xc1, 0xae, 0xd0, 0x0c, 0x8e, 0x94, 0xa3, 0xf7, 0x72, 0xdf, 0xf3, 0x83, 0x93, 0xdb, 0x09, - 0xd9, 0xf2, 0xaa, 0xd0, 0xde, 0xd8, 0xd8, 0xd8, 0xf2, 0xab, 0xf8, 0xf9, 0xd9, 0xb0, 0x87, 0xc4, - 0xaa, 0xf1, 0xdf, 0xdf, 0xbb, 0xaf, 0xdf, 0xdf, 0xb9, 0xd8, 0xb1, 0xf1, 0xa3, 0x97, 0x8e, 0x60, - /* bank # 10 */ - 0xdf, 0xb0, 0x84, 0xf2, 0xc8, 0x93, 0x85, 0xf1, 0x4a, 0xb1, 0x83, 0xa3, 0x08, 0xb5, 0x83, 0x9a, - 0x08, 0x10, 0xb7, 0x9f, 0x10, 0xb5, 0xd8, 0xf1, 0xb0, 0xba, 0xae, 0xb0, 0x8a, 0xc2, 0xb2, 0xb6, - 0x8e, 0x9e, 0xf1, 0xfb, 0xd9, 0xf4, 0x1d, 0xd8, 0xf9, 0xd9, 0x0c, 0xf1, 0xd8, 0xf8, 0xf8, 0xad, - 0x61, 0xd9, 0xae, 0xfb, 0xd8, 0xf4, 0x0c, 0xf1, 0xd8, 0xf8, 0xf8, 0xad, 0x19, 0xd9, 0xae, 0xfb, - 0xdf, 0xd8, 0xf4, 0x16, 0xf1, 0xd8, 0xf8, 0xad, 0x8d, 0x61, 0xd9, 0xf4, 0xf4, 0xac, 0xf5, 0x9c, - 0x9c, 0x8d, 0xdf, 0x2b, 0xba, 0xb6, 0xae, 0xfa, 0xf8, 0xf4, 0x0b, 0xd8, 0xf1, 0xae, 0xd0, 0xf8, - 0xad, 0x51, 0xda, 0xae, 0xfa, 0xf8, 0xf1, 0xd8, 0xb9, 0xb1, 0xb6, 0xa3, 0x83, 0x9c, 0x08, 0xb9, - 0xb1, 0x83, 0x9a, 0xb5, 0xaa, 0xc0, 0xfd, 0x30, 0x83, 0xb7, 0x9f, 0x10, 0xb5, 0x8b, 0x93, 0xf2, - 0x02, 0x02, 0xd1, 0xab, 0xda, 0xde, 0xd8, 0xd8, 0xb1, 0xb9, 0xf3, 0x8b, 0xa3, 0x91, 0xb6, 0x09, - 0xb4, 0xd9, 0xab, 0xde, 0xb0, 0x87, 0x9c, 0xb9, 0xa3, 0xdd, 0xf1, 0xb3, 0x8b, 0x8b, 0x8b, 0x8b, - 0x8b, 0xb0, 0x87, 0xa3, 0xa3, 0xa3, 0xa3, 0xb4, 0x90, 0x80, 0xf2, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, - 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xf1, 0x87, 0xb5, 0x9a, 0xa3, 0xf3, 0x9b, 0xa3, 0xa3, 0xdc, 0xba, - 0xac, 0xdf, 0xb9, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, 0xa3, - 0xa3, 0xa3, 0xa3, 0xd8, 0xd8, 0xd8, 0xbb, 0xb3, 0xb7, 0xf1, 0xaa, 0xf9, 0xda, 0xff, 0xd9, 0x80, - 0x9a, 0xaa, 0x28, 0xb4, 0x80, 0x98, 0xa7, 0x20, 0xb7, 0x97, 0x87, 0xa8, 0x66, 0x88, 0xf0, 0x79, - 0x51, 0xf1, 0x90, 0x2c, 0x87, 0x0c, 0xa7, 0x81, 0x97, 0x62, 0x93, 0xf0, 0x71, 0x71, 0x60, 0x85, - /* bank # 11 */ - 0x94, 0x01, 0x29, 0x51, 0x79, 0x90, 0xa5, 0xf1, 0x28, 0x4c, 0x6c, 0x87, 0x0c, 0x95, 0x18, 0x85, - 0x78, 0xa3, 0x83, 0x90, 0x28, 0x4c, 0x6c, 0x88, 0x6c, 0xd8, 0xf3, 0xa2, 0x82, 0x00, 0xf2, 0x10, - 0xa8, 0x92, 0x19, 0x80, 0xa2, 0xf2, 0xd9, 0x26, 0xd8, 0xf1, 0x88, 0xa8, 0x4d, 0xd9, 0x48, 0xd8, - 0x96, 0xa8, 0x39, 0x80, 0xd9, 0x3c, 0xd8, 0x95, 0x80, 0xa8, 0x39, 0xa6, 0x86, 0x98, 0xd9, 0x2c, - 0xda, 0x87, 0xa7, 0x2c, 0xd8, 0xa8, 0x89, 0x95, 0x19, 0xa9, 0x80, 0xd9, 0x38, 0xd8, 0xa8, 0x89, - 0x39, 0xa9, 0x80, 0xda, 0x3c, 0xd8, 0xa8, 0x2e, 0xa8, 0x39, 0x90, 0xd9, 0x0c, 0xd8, 0xa8, 0x95, - 0x31, 0x98, 0xd9, 0x0c, 0xd8, 0xa8, 0x09, 0xd9, 0xff, 0xd8, 0x01, 0xda, 0xff, 0xd8, 0x95, 0x39, - 0xa9, 0xda, 0x26, 0xff, 0xd8, 0x90, 0xa8, 0x0d, 0x89, 0x99, 0xa8, 0x10, 0x80, 0x98, 0x21, 0xda, - 0x2e, 0xd8, 0x89, 0x99, 0xa8, 0x31, 0x80, 0xda, 0x2e, 0xd8, 0xa8, 0x86, 0x96, 0x31, 0x80, 0xda, - 0x2e, 0xd8, 0xa8, 0x87, 0x31, 0x80, 0xda, 0x2e, 0xd8, 0xa8, 0x82, 0x92, 0xf3, 0x41, 0x80, 0xf1, - 0xd9, 0x2e, 0xd8, 0xa8, 0x82, 0xf3, 0x19, 0x80, 0xf1, 0xd9, 0x2e, 0xd8, 0x82, 0xac, 0xf3, 0xc0, - 0xa2, 0x80, 0x22, 0xf1, 0xa6, 0x2e, 0xa7, 0x2e, 0xa9, 0x22, 0x98, 0xa8, 0x29, 0xda, 0xac, 0xde, - 0xff, 0xd8, 0xa2, 0xf2, 0x2a, 0xf1, 0xa9, 0x2e, 0x82, 0x92, 0xa8, 0xf2, 0x31, 0x80, 0xa6, 0x96, - 0xf1, 0xd9, 0x00, 0xac, 0x8c, 0x9c, 0x0c, 0x30, 0xac, 0xde, 0xd0, 0xde, 0xff, 0xd8, 0x8c, 0x9c, - 0xac, 0xd0, 0x10, 0xac, 0xde, 0x80, 0x92, 0xa2, 0xf2, 0x4c, 0x82, 0xa8, 0xf1, 0xca, 0xf2, 0x35, - 0xf1, 0x96, 0x88, 0xa6, 0xd9, 0x00, 0xd8, 0xf1, 0xff -}; - -#define DMP_VERSION (dmpMemory) - -inv_error_t inv_write_dmp_data(FILE *fd, const unsigned char *dmp, size_t len) -{ - inv_error_t result = INV_SUCCESS; - int bytesWritten = 0; - - if (len <= 0) { - MPL_LOGE("Nothing to write"); - return INV_ERROR_FILE_WRITE; - } else { - MPL_LOGI("dmp firmware size to write = %d", len); - } - if (fd == NULL) { - return INV_ERROR_FILE_OPEN; - } - bytesWritten = fwrite(dmp, 1, len, fd); - if (bytesWritten != len) { - MPL_LOGE("bytes written (%d) don't match requested length (%d)\n", - bytesWritten, len); - result = INV_ERROR_FILE_WRITE; - } else { - MPL_LOGI("Bytes written = %d", bytesWritten); - } - return result; -} - -inv_error_t inv_load_dmp(FILE *fd) -{ - inv_error_t result = INV_SUCCESS; - result = inv_write_dmp_data(fd, DMP_VERSION, DMP_CODE_SIZE); - return result; -} - -/** - * @} - */ diff --git a/60xx/libsensors_iio/software/core/mllite/linux/ml_load_dmp.h b/60xx/libsensors_iio/software/core/mllite/linux/ml_load_dmp.h deleted file mode 100644 index 4d98692..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/ml_load_dmp.h +++ /dev/null @@ -1,33 +0,0 @@ -/* - $License: - Copyright (C) 2012 InvenSense Corporation, All Rights Reserved. - $ - */ - -/******************************************************************************* - * - * $Id:$ - * - ******************************************************************************/ - -#ifndef INV_LOAD_DMP_H -#define INV_LOAD_DMP_H - -#ifdef __cplusplus -extern "C" { -#endif - -/* - Includes. -*/ -#include "mltypes.h" - -/* - APIs -*/ -inv_error_t inv_load_dmp(FILE *fd); - -#ifdef __cplusplus -} -#endif -#endif /* INV_LOAD_DMP_H */ diff --git a/60xx/libsensors_iio/software/core/mllite/linux/ml_stored_data.c b/60xx/libsensors_iio/software/core/mllite/linux/ml_stored_data.c deleted file mode 100644 index b4c4249..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/ml_stored_data.c +++ /dev/null @@ -1,353 +0,0 @@ -/* - $License: - Copyright (C) 2011 InvenSense Corporation, All Rights Reserved. - $ - */ - -/****************************************************************************** - * - * $Id: ml_stored_data.c 6132 2011-10-01 03:17:27Z mcaramello $ - * - *****************************************************************************/ - -/** - * @defgroup ML_STORED_DATA - * - * @{ - * @file ml_stored_data.c - * @brief functions for reading and writing stored data sets. - * Typically, these functions process stored calibration data. - */ - -#include <stdio.h> - -#include "log.h" -#undef MPL_LOG_TAG -#define MPL_LOG_TAG "MPL-storeload" - -#include "ml_stored_data.h" -#include "storage_manager.h" -#include "mlos.h" - -#define LOADCAL_DEBUG 0 -#define STORECAL_DEBUG 0 - -#define DEFAULT_KEY 29681 - -#define STORECAL_LOG MPL_LOGI -#define LOADCAL_LOG MPL_LOGI - -inv_error_t inv_read_cal(unsigned char **calData, size_t *bytesRead) -{ - FILE *fp; - inv_error_t result = INV_SUCCESS; - size_t fsize; - - fp = fopen(MLCAL_FILE,"rb"); - if (fp == NULL) { - MPL_LOGE("Cannot open file \"%s\" for read\n", MLCAL_FILE); - return INV_ERROR_FILE_OPEN; - } - - // obtain file size - fseek (fp, 0 , SEEK_END); - fsize = ftell (fp); - rewind (fp); - - *calData = (unsigned char *)inv_malloc(fsize); - if (*calData==NULL) { - MPL_LOGE("Could not allocate buffer of %d bytes - " - "aborting\n", fsize); - fclose(fp); - return INV_ERROR_MEMORY_EXAUSTED; - } - - *bytesRead = fread(*calData, 1, fsize, fp); - if (*bytesRead != fsize) { - MPL_LOGE("bytes read (%d) don't match file size (%d)\n", - *bytesRead, fsize); - result = INV_ERROR_FILE_READ; - goto read_cal_end; - } - else { - MPL_LOGI("Bytes read = %d", *bytesRead); - } - -read_cal_end: - fclose(fp); - return result; -} - -inv_error_t inv_write_cal(unsigned char *cal, size_t len) -{ - FILE *fp; - int bytesWritten; - inv_error_t result = INV_SUCCESS; - - if (len <= 0) { - MPL_LOGE("Nothing to write"); - return INV_ERROR_FILE_WRITE; - } - else { - MPL_LOGI("cal data size to write = %d", len); - } - fp = fopen(MLCAL_FILE,"wb"); - if (fp == NULL) { - MPL_LOGE("Cannot open file \"%s\" for write\n", MLCAL_FILE); - return INV_ERROR_FILE_OPEN; - } - bytesWritten = fwrite(cal, 1, len, fp); - if (bytesWritten != len) { - MPL_LOGE("bytes written (%d) don't match requested length (%d)\n", - bytesWritten, len); - result = INV_ERROR_FILE_WRITE; - } - else { - MPL_LOGI("Bytes written = %d", bytesWritten); - } - fclose(fp); - return result; -} - -/** - * @brief Loads a type 0 set of calibration data. - * It parses a binary data set containing calibration data. - * The binary data set is intended to be loaded from a file. - * This calibrations data format stores values for (in order of - * appearance) : - * - temperature compensation : temperature data points, - * - temperature compensation : gyro biases data points for X, Y, - * and Z axes. - * - accel biases for X, Y, Z axes. - * This calibration data is produced internally by the MPL and its - * size is 2777 bytes (header and checksum included). - * Calibration format type 1 is currently used for ITG3500 - * - * @pre inv_init_storage_manager() - * must have been called. - * - * @param calData - * A pointer to an array of bytes to be parsed. - * @param len - * the length of the calibration - * - * @return INV_SUCCESS if successful, a non-zero error code otherwise. - */ -inv_error_t inv_load_cal_V0(unsigned char *calData, size_t len) -{ - inv_error_t result; - - LOADCAL_LOG("Entering inv_load_cal_V0\n"); - - /*if (len != expLen) { - MPL_LOGE("Calibration data type 0 must be %d bytes long (got %d)\n", - expLen, len); - return INV_ERROR_FILE_READ; - }*/ - - result = inv_load_mpl_states(calData, len); - return result; -} - -/** - * @brief Loads a type 1 set of calibration data. - * It parses a binary data set containing calibration data. - * The binary data set is intended to be loaded from a file. - * This calibrations data format stores values for (in order of - * appearance) : - * - temperature, - * - gyro biases for X, Y, Z axes, - * - accel biases for X, Y, Z axes. - * This calibration data would normally be produced by the MPU Self - * Test and its size is 36 bytes (header and checksum included). - * Calibration format type 1 is produced by the MPU Self Test and - * substitutes the type 0 : inv_load_cal_V0(). - * - * @pre - * - * @param calData - * A pointer to an array of bytes to be parsed. - * @param len - * the length of the calibration - * - * @return INV_SUCCESS if successful, a non-zero error code otherwise. - */ -inv_error_t inv_load_cal_V1(unsigned char *calData, size_t len) -{ - return INV_SUCCESS; -} - -/** - * @brief Loads a set of calibration data. - * It parses a binary data set containing calibration data. - * The binary data set is intended to be loaded from a file. - * - * @pre - * - * - * @param calData - * A pointer to an array of bytes to be parsed. - * - * @return INV_SUCCESS if successful, a non-zero error code otherwise. - */ -inv_error_t inv_load_cal(unsigned char *calData) -{ - int calType = 0; - int len = 0; - //int ptr; - //uint32_t chk = 0; - //uint32_t cmp_chk = 0; - - /*load_func_t loaders[] = { - inv_load_cal_V0, - inv_load_cal_V1, - }; - */ - - inv_load_cal_V0(calData, len); - - /* read the header (type and len) - len is the total record length including header and checksum */ - len = 0; - len += 16777216L * ((int)calData[0]); - len += 65536L * ((int)calData[1]); - len += 256 * ((int)calData[2]); - len += (int)calData[3]; - - calType = ((int)calData[4]) * 256 + ((int)calData[5]); - if (calType > 5) { - MPL_LOGE("Unsupported calibration file format %d. " - "Valid types 0..5\n", calType); - return INV_ERROR_INVALID_PARAMETER; - } - - /* call the proper method to read in the data */ - //return loaders[calType] (calData, len); - return 0; -} - -/** - * @brief Stores a set of calibration data. - * It generates a binary data set containing calibration data. - * The binary data set is intended to be stored into a file. - * - * @pre inv_dmp_open() - * - * @param calData - * A pointer to an array of bytes to be stored. - * @param length - * The amount of bytes available in the array. - * - * @return INV_SUCCESS if successful, a non-zero error code otherwise. - */ -inv_error_t inv_store_cal(unsigned char *calData, size_t length) -{ - inv_error_t res = 0; - size_t size; - - STORECAL_LOG("Entering inv_store_cal\n"); - - inv_get_mpl_state_size(&size); - - MPL_LOGI("inv_get_mpl_state_size() : size=%d", size); - - /* store data */ - res = inv_save_mpl_states(calData, size); - if(res != 0) - { - MPL_LOGE("inv_save_mpl_states() failed"); - } - - STORECAL_LOG("Exiting inv_store_cal\n"); - return INV_SUCCESS; -} - -/** - * @brief Load a calibration file. - * - * @pre Must be in INV_STATE_DMP_OPENED state. - * inv_dmp_open() or inv_dmp_stop() must have been called. - * inv_dmp_start() and inv_dmp_close() must have <b>NOT</b> - * been called. - * - * @return 0 or error code. - */ -inv_error_t inv_load_calibration(void) -{ - unsigned char *calData= NULL; - inv_error_t result = 0; - size_t bytesRead = 0; - - result = inv_read_cal(&calData, &bytesRead); - if(result != INV_SUCCESS) { - MPL_LOGE("Could not load cal file - " - "aborting\n"); - goto free_mem_n_exit; - } - - result = inv_load_mpl_states(calData, bytesRead); - if (result != INV_SUCCESS) { - MPL_LOGE("Could not load the calibration data - " - "error %d - aborting\n", result); - goto free_mem_n_exit; - } - -free_mem_n_exit: - inv_free(calData); - return result; -} - -/** - * @brief Store runtime calibration data to a file - * - * @pre Must be in INV_STATE_DMP_OPENED state. - * inv_dmp_open() or inv_dmp_stop() must have been called. - * inv_dmp_start() and inv_dmp_close() must have <b>NOT</b> - * been called. - * - * @return 0 or error code. - */ -inv_error_t inv_store_calibration(void) -{ - unsigned char *calData; - inv_error_t result; - size_t length; - - result = inv_get_mpl_state_size(&length); - calData = (unsigned char *)inv_malloc(length); - if (!calData) { - MPL_LOGE("Could not allocate buffer of %d bytes - " - "aborting\n", length); - return INV_ERROR_MEMORY_EXAUSTED; - } - else { - MPL_LOGI("mpl state size = %d", length); - } - - result = inv_save_mpl_states(calData, length); - if (result != INV_SUCCESS) { - MPL_LOGE("Could not save mpl states - " - "error %d - aborting\n", result); - goto free_mem_n_exit; - } - else { - MPL_LOGE("calData from inv_save_mpl_states, size=%d", - strlen((char *)calData)); - } - - result = inv_write_cal(calData, length); - if (result != INV_SUCCESS) { - MPL_LOGE("Could not store calibrated data on file - " - "error %d - aborting\n", result); - goto free_mem_n_exit; - - } - -free_mem_n_exit: - inv_free(calData); - return result; -} - -/** - * @} - */ diff --git a/60xx/libsensors_iio/software/core/mllite/linux/ml_stored_data.h b/60xx/libsensors_iio/software/core/mllite/linux/ml_stored_data.h deleted file mode 100644 index 115b34c..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/ml_stored_data.h +++ /dev/null @@ -1,53 +0,0 @@ -/* - $License: - Copyright (C) 2011 InvenSense Corporation, All Rights Reserved. - $ - */ - -/******************************************************************************* - * - * $Id: ml_stored_data.h 5873 2011-08-11 03:13:48Z mcaramello $ - * - ******************************************************************************/ - -#ifndef INV_MPL_STORED_DATA_H -#define INV_MPL_STORED_DATA_H - -#ifdef __cplusplus -extern "C" { -#endif - -/* - Includes. -*/ -#include "mltypes.h" - -/* - Defines -*/ -#define MLCAL_FILE "/data/inv_cal_data.bin" - -/* - APIs -*/ -inv_error_t inv_load_calibration(void); -inv_error_t inv_store_calibration(void); - -/* - Internal APIs -*/ -inv_error_t inv_read_cal(unsigned char **, size_t *); -inv_error_t inv_write_cal(unsigned char *cal, size_t len); -inv_error_t inv_load_cal_V0(unsigned char *calData, size_t len); -inv_error_t inv_load_cal_V1(unsigned char *calData, size_t len); - -/* - Other prototypes -*/ -inv_error_t inv_load_cal(unsigned char *calData); -inv_error_t inv_store_cal(unsigned char *calData, size_t length); - -#ifdef __cplusplus -} -#endif -#endif /* INV_MPL_STORED_DATA_H */ diff --git a/60xx/libsensors_iio/software/core/mllite/linux/ml_sysfs_helper.c b/60xx/libsensors_iio/software/core/mllite/linux/ml_sysfs_helper.c deleted file mode 100644 index d0c4513..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/ml_sysfs_helper.c +++ /dev/null @@ -1,423 +0,0 @@ -#include <string.h> -#include <stdio.h> -#include "ml_sysfs_helper.h" -#include <dirent.h> -#include <ctype.h> -#define MPU_SYSFS_ABS_PATH "/sys/class/invensense/mpu" - -enum PROC_SYSFS_CMD { - CMD_GET_SYSFS_PATH, - CMD_GET_DMP_PATH, - CMD_GET_CHIP_NAME, - CMD_GET_SYSFS_KEY, - CMD_GET_TRIGGER_PATH, - CMD_GET_DEVICE_NODE -}; -static char sysfs_path[100]; -static char *chip_name[] = { - "ITG3500", - "MPU6050", - "MPU9150", - "MPU3050", - "MPU6500" -}; -static int chip_ind; -static int initialized =0; -static int status = 0; -static int iio_initialized = 0; -static int iio_dev_num = 0; - -#define IIO_MAX_NAME_LENGTH 30 - -#define FORMAT_SCAN_ELEMENTS_DIR "%s/scan_elements" -#define FORMAT_TYPE_FILE "%s_type" - -#define CHIP_NUM ARRAY_SIZE(chip_name) - -static const char *iio_dir = "/sys/bus/iio/devices/"; - -/** - * find_type_by_name() - function to match top level types by name - * @name: top level type instance name - * @type: the type of top level instance being sort - * - * Typical types this is used for are device and trigger. - **/ -int find_type_by_name(const char *name, const char *type) -{ - const struct dirent *ent; - int number, numstrlen; - - FILE *nameFile; - DIR *dp; - char thisname[IIO_MAX_NAME_LENGTH]; - char *filename; - - dp = opendir(iio_dir); - if (dp == NULL) { - printf("No industrialio devices available"); - return -ENODEV; - } - - while (ent = readdir(dp), ent != NULL) { - if (strcmp(ent->d_name, ".") != 0 && - strcmp(ent->d_name, "..") != 0 && - strlen(ent->d_name) > strlen(type) && - strncmp(ent->d_name, type, strlen(type)) == 0) { - numstrlen = sscanf(ent->d_name + strlen(type), - "%d", - &number); - /* verify the next character is not a colon */ - if (strncmp(ent->d_name + strlen(type) + numstrlen, - ":", - 1) != 0) { - filename = malloc(strlen(iio_dir) - + strlen(type) - + numstrlen - + 6); - if (filename == NULL) - return -ENOMEM; - sprintf(filename, "%s%s%d/name", - iio_dir, - type, - number); - nameFile = fopen(filename, "r"); - if (!nameFile) - continue; - free(filename); - fscanf(nameFile, "%s", thisname); - if (strcmp(name, thisname) == 0) - return number; - fclose(nameFile); - } - } - } - return -ENODEV; -} - -/* mode 0: search for which chip in the system and fill sysfs path - mode 1: return event number - */ -static int parsing_proc_input(int mode, char *name){ - const char input[] = "/proc/bus/input/devices"; - char line[4096], d; - char tmp[100]; - FILE *fp; - int i, j, result, find_flag; - int event_number = -1; - int input_number = -1; - - if(NULL == (fp = fopen(input, "rt")) ){ - return -1; - } - result = 1; - find_flag = 0; - while(result != 0 && find_flag < 2){ - i = 0; - d = 0; - memset(line, 0, 100); - while(d != '\n'){ - result = fread(&d, 1, 1, fp); - if(result == 0){ - line[0] = 0; - break; - } - sprintf(&line[i], "%c", d); - i ++; - } - if(line[0] == 'N'){ - i = 1; - while(line[i] != '"'){ - i++; - } - i++; - j = 0; - find_flag = 0; - if (mode == 0){ - while(j < CHIP_NUM){ - if(!memcmp(&line[i], chip_name[j], strlen(chip_name[j]))){ - find_flag = 1; - chip_ind = j; - } - j++; - } - } else if (mode != 0){ - if(!memcmp(&line[i], name, strlen(name))){ - find_flag = 1; - } - } - } - if(find_flag){ - if(mode == 0){ - if(line[0] == 'S'){ - memset(tmp, 0, 100); - i =1; - while(line[i] != '=') i++; - i++; - j = 0; - while(line[i] != '\n'){ - tmp[j] = line[i]; - i ++; j++; - } - sprintf(sysfs_path, "%s%s", "/sys", tmp); - find_flag++; - } - } else if(mode == 1){ - if(line[0] == 'H') { - i = 2; - while(line[i] != '=') i++; - while(line[i] != 't') i++; - i++; - event_number = 0; - while(line[i] != '\n'){ - if(line[i] >= '0' && line[i] <= '9') - event_number = event_number*10 + line[i]-0x30; - i ++; - } - find_flag ++; - } - } else if (mode == 2) { - if(line[0] == 'S'){ - memset(tmp, 0, 100); - i =1; - while(line[i] != '=') i++; - i++; - j = 0; - while(line[i] != '\n'){ - tmp[j] = line[i]; - i ++; j++; - } - input_number = 0; - if(tmp[j-2] >= '0' && tmp[j-2] <= '9') - input_number += (tmp[j-2]-0x30)*10; - if(tmp[j-1] >= '0' && tmp[j-1] <= '9') - input_number += (tmp[j-1]-0x30); - find_flag++; - } - } - } - } - fclose(fp); - if(find_flag == 0){ - return -1; - } - if(0 == mode) - status = 1; - if (mode == 1) - return event_number; - if (mode == 2) - return input_number; - return 0; - -} -static void init_iio() { - int i, j; - char iio_chip[10]; - int dev_num; - for(j=0; j< CHIP_NUM; j++) { - for (i=0; i<strlen(chip_name[j]); i++) { - iio_chip[i] = tolower(chip_name[j][i]); - } - iio_chip[strlen(chip_name[0])] = '\0'; - dev_num = find_type_by_name(iio_chip, "iio:device"); - if(dev_num >= 0) { - iio_initialized = 1; - iio_dev_num = dev_num; - chip_ind = j; - } - } -} - -static int process_sysfs_request(enum PROC_SYSFS_CMD cmd, char *data) -{ - char key_path[100]; - FILE *fp; - int i, result; - if(initialized == 0){ - parsing_proc_input(0, NULL); - initialized = 1; - } - if(initialized && status == 0) { - init_iio(); - if (iio_initialized == 0) - return -1; - } - - memset(key_path, 0, 100); - switch(cmd){ - case CMD_GET_SYSFS_PATH: - if (iio_initialized == 1) - sprintf(data, "/sys/bus/iio/devices/iio:device%d", iio_dev_num); - else - sprintf(data, "%s%s", sysfs_path, "/device/invensense/mpu"); - break; - case CMD_GET_DMP_PATH: - if (iio_initialized == 1) - sprintf(data, "/sys/bus/iio/devices/iio:device%d/dmp_firmware", iio_dev_num); - else - sprintf(data, "%s%s", sysfs_path, "/device/invensense/mpu/dmp_firmware"); - break; - case CMD_GET_CHIP_NAME: - sprintf(data, "%s", chip_name[chip_ind]); - break; - case CMD_GET_TRIGGER_PATH: - sprintf(data, "/sys/bus/iio/devices/trigger%d", iio_dev_num); - break; - case CMD_GET_DEVICE_NODE: - sprintf(data, "/dev/iio:device%d", iio_dev_num); - break; - case CMD_GET_SYSFS_KEY: - memset(key_path, 0, 100); - if (iio_initialized == 1) - sprintf(key_path, "/sys/bus/iio/devices/iio:device%d/key", iio_dev_num); - else - sprintf(key_path, "%s%s", sysfs_path, "/device/invensense/mpu/key"); - - if((fp = fopen(key_path, "rt")) == NULL) - return -1; - for(i=0;i<16;i++){ - fscanf(fp, "%02x", &result); - data[i] = (char)result; - } - - fclose(fp); - break; - default: - break; - } - return 0; -} -/** - * @brief return sysfs key. if the key is not available - * return false. So the return value must be checked - * to make sure the path is valid. - * @unsigned char *name: This should be array big enough to hold the key - * It should be zeroed before calling this function. - * Or it could have unpredicable result. - */ -inv_error_t inv_get_sysfs_key(unsigned char *key) -{ - if (process_sysfs_request(CMD_GET_SYSFS_KEY, (char*)key) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} - -/** - * @brief return the sysfs path. If the path is not - * found yet. return false. So the return value must be checked - * to make sure the path is valid. - * @unsigned char *name: This should be array big enough to hold the sysfs - * path. It should be zeroed before calling this function. - * Or it could have unpredicable result. - */ -inv_error_t inv_get_sysfs_path(char *name) -{ - if (process_sysfs_request(CMD_GET_SYSFS_PATH, name) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} - -inv_error_t inv_get_sysfs_abs_path(char *name) -{ - strcpy(name, MPU_SYSFS_ABS_PATH); - return INV_SUCCESS; -} - -/** - * @brief return the dmp file path. If the path is not - * found yet. return false. So the return value must be checked - * to make sure the path is valid. - * @unsigned char *name: This should be array big enough to hold the dmp file - * path. It should be zeroed before calling this function. - * Or it could have unpredicable result. - */ -inv_error_t inv_get_dmpfile(char *name) -{ - if (process_sysfs_request(CMD_GET_DMP_PATH, name) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} -/** - * @brief return the chip name. If the chip is not - * found yet. return false. So the return value must be checked - * to make sure the path is valid. - * @unsigned char *name: This should be array big enough to hold the chip name - * path(8 bytes). It should be zeroed before calling this function. - * Or it could have unpredicable result. - */ -inv_error_t inv_get_chip_name(char *name) -{ - if (process_sysfs_request(CMD_GET_CHIP_NAME, name) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} -/** - * @brief return event handler number. If the handler number is not found - * return false. the return value must be checked - * to make sure the path is valid. - * @unsigned char *name: This should be array big enough to hold the chip name - * path(8 bytes). It should be zeroed before calling this function. - * Or it could have unpredicable result. - * @int *num: event number store - */ -inv_error_t inv_get_handler_number(const char *name, int *num) -{ - initialized = 0; - if ((*num = parsing_proc_input(1, (char *)name)) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} - -/** - * @brief return input number. If the handler number is not found - * return false. the return value must be checked - * to make sure the path is valid. - * @unsigned char *name: This should be array big enough to hold the chip name - * path(8 bytes). It should be zeroed before calling this function. - * Or it could have unpredicable result. - * @int *num: input number store - */ -inv_error_t inv_get_input_number(const char *name, int *num) -{ - initialized = 0; - if ((*num = parsing_proc_input(2, (char *)name)) < 0) - return INV_ERROR_NOT_OPENED; - else { - return INV_SUCCESS; - } -} - -/** - * @brief return iio trigger name. If iio is not initialized, return false. - * So the return must be checked to make sure the numeber is valid. - * @unsigned char *name: This should be array big enough to hold the trigger - * name. It should be zeroed before calling this function. - * Or it could have unpredicable result. - */ -inv_error_t inv_get_iio_trigger_path(char *name) -{ - if (process_sysfs_request(CMD_GET_TRIGGER_PATH, (char *)name) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} - -/** - * @brief return iio device node. If iio is not initialized, return false. - * So the return must be checked to make sure the numeber is valid. - * @unsigned char *name: This should be array big enough to hold the device - * node. It should be zeroed before calling this function. - * Or it could have unpredicable result. - */ -inv_error_t inv_get_iio_device_node(char *name) -{ - if (process_sysfs_request(CMD_GET_DEVICE_NODE, (char *)name) < 0) - return INV_ERROR_NOT_OPENED; - else - return INV_SUCCESS; -} diff --git a/60xx/libsensors_iio/software/core/mllite/linux/ml_sysfs_helper.h b/60xx/libsensors_iio/software/core/mllite/linux/ml_sysfs_helper.h deleted file mode 100644 index 9470874..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/ml_sysfs_helper.h +++ /dev/null @@ -1,36 +0,0 @@ -/* - $License: - Copyright (C) 2011 InvenSense Corporation, All Rights Reserved. - $ - */ - -/******************************************************************************* - * - * $Id$ - * - ******************************************************************************/ - -#ifndef MLDMP_SYSFS_HELPER_H__ -#define MLDMP_SYSFS_HELPER_H__ - -#ifdef __cplusplus -extern "C" { -#endif - -#include "invensense.h" - -int find_type_by_name(const char *name, const char *type); -inv_error_t inv_get_sysfs_path(char *name); -inv_error_t inv_get_sysfs_abs_path(char *name); -inv_error_t inv_get_dmpfile(char *name); -inv_error_t inv_get_chip_name(char *name); -inv_error_t inv_get_sysfs_key(unsigned char *key); -inv_error_t inv_get_handler_number(const char *name, int *num); -inv_error_t inv_get_input_number(const char *name, int *num); -inv_error_t inv_get_iio_trigger_path(char *name); -inv_error_t inv_get_iio_device_node(char *name); - -#ifdef __cplusplus -} -#endif -#endif /* MLDMP_SYSFS_HELPER_H__ */ diff --git a/60xx/libsensors_iio/software/core/mllite/linux/mlos.h b/60xx/libsensors_iio/software/core/mllite/linux/mlos.h deleted file mode 100644 index d4f8912..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/mlos.h +++ /dev/null @@ -1,99 +0,0 @@ -/* - $License: - Copyright (C) 2011 InvenSense Corporation, All Rights Reserved. - $ - */ - -#ifndef _MLOS_H -#define _MLOS_H - -#ifndef __KERNEL__ -#include <stdio.h> -#endif -#include <pthread.h> - -#include "mltypes.h" - -#ifdef __cplusplus -extern "C" { -#endif - -#if defined(LINUX) || defined(__KERNEL__) -typedef pthread_mutex_t* HANDLE; -#endif - - /* ------------ */ - /* - Defines. - */ - /* ------------ */ - - /* - MLOSCreateFile defines. - */ - -#define MLOS_GENERIC_READ ((unsigned int)0x80000000) -#define MLOS_GENERIC_WRITE ((unsigned int)0x40000000) -#define MLOS_FILE_SHARE_READ ((unsigned int)0x00000001) -#define MLOS_FILE_SHARE_WRITE ((unsigned int)0x00000002) -#define MLOS_OPEN_EXISTING ((unsigned int)0x00000003) - - /* ---------- */ - /* - Enums. - */ - /* ---------- */ - - /* --------------- */ - /* - Structures. - */ - /* --------------- */ - - /* --------------------- */ - /* - Function p-types. - */ - /* --------------------- */ - -#ifndef __KERNEL__ -#include <string.h> - void *inv_malloc(unsigned int numBytes); - inv_error_t inv_free(void *ptr); - inv_error_t inv_create_mutex(HANDLE *mutex); - inv_error_t inv_lock_mutex(HANDLE mutex); - inv_error_t inv_unlock_mutex(HANDLE mutex); - FILE *inv_fopen(char *filename); - void inv_fclose(FILE *fp); - - inv_error_t inv_destroy_mutex(HANDLE handle); - - void inv_sleep(int mSecs); - unsigned long inv_get_tick_count(void); - - /* Kernel implmentations */ -#define GFP_KERNEL (0x70) - static inline void *kmalloc(size_t size, - unsigned int gfp_flags) - { - (void)gfp_flags; - return inv_malloc((unsigned int)size); - } - static inline void *kzalloc(size_t size, unsigned int gfp_flags) - { - void *tmp = inv_malloc((unsigned int)size); - (void)gfp_flags; - if (tmp) - memset(tmp, 0, size); - return tmp; - } - static inline void kfree(void *ptr) - { - inv_free(ptr); - } - static inline void msleep(long msecs) - { - inv_sleep(msecs); - } - static inline void udelay(unsigned long usecs) - { - inv_sleep((usecs + 999) / 1000); - } -#else -#include <linux/delay.h> -#endif - -#ifdef __cplusplus -} -#endif -#endif /* _MLOS_H */ diff --git a/60xx/libsensors_iio/software/core/mllite/linux/mlos_linux.c b/60xx/libsensors_iio/software/core/mllite/linux/mlos_linux.c deleted file mode 100644 index 5424508..0000000 --- a/60xx/libsensors_iio/software/core/mllite/linux/mlos_linux.c +++ /dev/null @@ -1,190 +0,0 @@ -/* - $License: - Copyright (C) 2012 InvenSense Corporation, All Rights Reserved. - $ - */ - -/******************************************************************************* - * - * $Id: mlos_linux.c 5629 2011-06-11 03:13:08Z mcaramello $ - * - ******************************************************************************/ - -/** - * @defgroup MLOS - * @brief OS Interface. - * - * @{ - * @file mlos.c - * @brief OS Interface. - */ - -/* ------------- */ -/* - Includes. - */ -/* ------------- */ - -#include <sys/time.h> -#include <unistd.h> -#include <pthread.h> -#include <stdlib.h> -#include <errno.h> - -#include "stdint_invensense.h" -#include "mlos.h" - - -/* -------------- */ -/* - Functions. - */ -/* -------------- */ - -/** - * @brief Allocate space - * @param num_bytes number of bytes - * @return pointer to allocated space - */ -void *inv_malloc(unsigned int num_bytes) -{ - // Allocate space. - void *alloc_ptr = malloc(num_bytes); - return alloc_ptr; -} - - -/** - * @brief Free allocated space - * @param ptr pointer to space to deallocate - * @return error code. - */ -inv_error_t inv_free(void *ptr) -{ - if (ptr) - free(ptr); - return INV_SUCCESS; -} - - -/** - * @brief Mutex create function - * @param mutex pointer to mutex handle - * @return error code. - */ -inv_error_t inv_create_mutex(HANDLE *mutex) -{ - int res; - pthread_mutex_t *pm = malloc(sizeof(pthread_mutex_t)); - if(pm == NULL) - return INV_ERROR; - - res = pthread_mutex_init(pm, NULL); - if(res == -1) { - free(pm); - return INV_ERROR_OS_CREATE_FAILED; - } - - *mutex = (HANDLE)pm; - - return INV_SUCCESS; -} - - -/** - * @brief Mutex lock function - * @param mutex Mutex handle - * @return error code. - */ -inv_error_t inv_lock_mutex(HANDLE mutex) -{ - int res; - pthread_mutex_t *pm = (pthread_mutex_t *)mutex; - - res = pthread_mutex_lock(pm); - if(res == -1) - return INV_ERROR_OS_LOCK_FAILED; - - return INV_SUCCESS; -} - - -/** - * @brief Mutex unlock function - * @param mutex mutex handle - * @return error code. - */ -inv_error_t inv_unlock_mutex(HANDLE mutex) -{ - int res; - pthread_mutex_t *pm = (pthread_mutex_t *)mutex; - - res = pthread_mutex_unlock(pm); - if(res == -1) - return INV_ERROR_OS_LOCK_FAILED; - - return INV_SUCCESS; -} - - -/** - * @brief open file - * @param filename name of the file to open. - * @return error code. - */ -FILE *inv_fopen(char *filename) -{ - FILE *fp = fopen(filename, "r"); - return fp; -} - - -/** - * @brief close the file. - * @param fp handle to file to close. - * @return error code. - */ -void inv_fclose(FILE *fp) -{ - fclose(fp); -} - -/** - * @brief Close Handle - * @param handle handle to the resource. - * @return Zero if success, an error code otherwise. - */ -inv_error_t inv_destroy_mutex(HANDLE handle) -{ - int error; - pthread_mutex_t *pm = (pthread_mutex_t *)handle; - error = pthread_mutex_destroy(pm); - if (error) - return errno; - free((void*) handle); - - return INV_SUCCESS;} - - -/** - * @brief Sleep function. - */ -void inv_sleep(int m_secs) -{ - usleep(m_secs * 1000); -} - - -/** - * @brief get system's internal tick count. - * Used for time reference. - * @return current tick count. - */ -unsigned long inv_get_tick_count() -{ - struct timeval tv; - - if (gettimeofday(&tv, NULL) != 0) - return 0; - - return (long)((tv.tv_sec * 1000000LL + tv.tv_usec) / 1000LL); -} - -/** @} */ - |