examples: Created mraa-i2c tool for i2c layer testing.
Signed-off-by: Henry Bruce <henry.bruce@intel.com> Signed-off-by: Brendan Le Foll <brendan.le.foll@intel.com>
This commit is contained in:
committed by
Brendan Le Foll
parent
8f48df0533
commit
6dfe6ff6bc
@@ -10,9 +10,13 @@ add_executable (mmap-io2 mmap-io2.c)
|
||||
add_executable (blink_onboard blink_onboard.c)
|
||||
add_executable (uart uart.c)
|
||||
add_executable (mraa-gpio mraa-gpio.c)
|
||||
add_executable (mraa-i2c mraa-i2c.c)
|
||||
add_executable (spi_max7219 spi_max7219.c)
|
||||
|
||||
include_directories(${PROJECT_SOURCE_DIR}/api)
|
||||
# FIXME Hack to access internal types used by mraa-i2c
|
||||
include_directories(${PROJECT_SOURCE_DIR}/include)
|
||||
include_directories(${PROJECT_SOURCE_DIR}/api/mraa)
|
||||
|
||||
target_link_libraries (hellomraa mraa)
|
||||
target_link_libraries (i2c_HMC5883L mraa m)
|
||||
@@ -26,6 +30,7 @@ target_link_libraries (mmap-io2 mraa)
|
||||
target_link_libraries (blink_onboard mraa)
|
||||
target_link_libraries (uart mraa)
|
||||
target_link_libraries (mraa-gpio mraa)
|
||||
target_link_libraries (mraa-i2c mraa)
|
||||
target_link_libraries (spi_max7219 mraa)
|
||||
|
||||
add_subdirectory (c++)
|
||||
|
||||
249
examples/mraa-i2c.c
Normal file
249
examples/mraa-i2c.c
Normal file
@@ -0,0 +1,249 @@
|
||||
/*
|
||||
* Author: Henry Bruce <henry.bruce@intel.com>
|
||||
* Copyright (c) 2014 Intel Corporation.
|
||||
*
|
||||
* 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 <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include "mraa/i2c.h"
|
||||
|
||||
#include "mraa_internal_types.h"
|
||||
|
||||
extern mraa_board_t* plat;
|
||||
|
||||
void
|
||||
print_version()
|
||||
{
|
||||
fprintf(stdout, "Version %s on %s", mraa_get_version(), mraa_get_platform_name());
|
||||
if (plat != NULL && plat->sub_platform != NULL)
|
||||
fprintf(stdout, " with %s", plat->sub_platform->platform_name);
|
||||
fprintf(stdout, "\n");
|
||||
}
|
||||
|
||||
void
|
||||
print_help()
|
||||
{
|
||||
fprintf(stdout, "version Get mraa version and board name\n");
|
||||
fprintf(stdout, "list List available busses\n");
|
||||
fprintf(stdout, "detect bus List detected devices on specified bus\n");
|
||||
fprintf(stdout, "get bus device reg Get value from specified device register\n");
|
||||
fprintf(stdout, "set bus device reg value Set specified device register to value\n");
|
||||
}
|
||||
|
||||
void
|
||||
print_command_error()
|
||||
{
|
||||
fprintf(stdout, "Invalid command, options are:\n");
|
||||
print_help();
|
||||
}
|
||||
|
||||
|
||||
|
||||
void
|
||||
print_bus(mraa_board_t* board)
|
||||
{
|
||||
int bus_index;
|
||||
int bus;
|
||||
for (bus = 0; bus < board->i2c_bus_count; ++bus) {
|
||||
char* busType;
|
||||
switch (mraa_get_platform_type()) {
|
||||
case MRAA_INTEL_GALILEO_GEN1:
|
||||
case MRAA_INTEL_GALILEO_GEN2:
|
||||
case MRAA_INTEL_EDISON_FAB_C:
|
||||
case MRAA_INTEL_DE3815:
|
||||
case MRAA_INTEL_MINNOWBOARD_MAX:
|
||||
case MRAA_RASPBERRY_PI:
|
||||
case MRAA_BEAGLEBONE:
|
||||
case MRAA_BANANA:
|
||||
bus_index = bus;
|
||||
busType = "stdapi";
|
||||
break;
|
||||
case MRAA_FTDI_FT4222:
|
||||
busType = "ft4222";
|
||||
bus_index = MRAA_USE_SUB_PLATFORM(bus);
|
||||
break;
|
||||
default:
|
||||
busType = "unknown";
|
||||
break;
|
||||
}
|
||||
fprintf(stdout, "Bus %2d: id=%02d type=%s ", bus_index, plat->i2c_bus[bus].bus_id, busType);
|
||||
if (bus == plat->def_i2c_bus)
|
||||
fprintf(stdout, " default", bus);
|
||||
fprintf(stdout, "\n", bus);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
void
|
||||
print_busses()
|
||||
{
|
||||
print_bus(plat);
|
||||
if (plat->sub_platform != NULL)
|
||||
print_bus(plat->sub_platform);
|
||||
}
|
||||
|
||||
|
||||
|
||||
mraa_result_t
|
||||
i2c_get(int bus, uint8_t device_address, uint8_t register_address, uint8_t* data)
|
||||
{
|
||||
mraa_result_t status = MRAA_SUCCESS;
|
||||
mraa_i2c_context i2c = mraa_i2c_init(bus);
|
||||
if (i2c == NULL) {
|
||||
status = MRAA_ERROR_NO_RESOURCES;
|
||||
// fprintf(stdout, "Could not initialize i2c\n");
|
||||
goto i2c_get_exit;
|
||||
}
|
||||
status = mraa_i2c_address(i2c, device_address);
|
||||
if (status != MRAA_SUCCESS) {
|
||||
// fprintf(stdout, "Could not set i2c device address\n");
|
||||
goto i2c_get_exit;
|
||||
}
|
||||
status = mraa_i2c_write_byte(i2c, register_address);
|
||||
if (status != MRAA_SUCCESS) {
|
||||
// fprintf(stdout, "Could not set i2c register address. Status = %d\n", status);
|
||||
goto i2c_get_exit;
|
||||
}
|
||||
status = mraa_i2c_read(i2c, data, 1) == 1 ? MRAA_SUCCESS : MRAA_ERROR_UNSPECIFIED;
|
||||
if (status != MRAA_SUCCESS) {
|
||||
// fprintf(stdout, "i2c read failed\n");
|
||||
goto i2c_get_exit;
|
||||
}
|
||||
i2c_get_exit:
|
||||
if (i2c != NULL)
|
||||
mraa_i2c_stop(i2c);
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
mraa_result_t
|
||||
i2c_set(int bus, uint8_t device_address, uint8_t register_address, uint8_t data)
|
||||
{
|
||||
mraa_result_t status = MRAA_SUCCESS;
|
||||
mraa_i2c_context i2c = mraa_i2c_init(bus);
|
||||
if (i2c == NULL) {
|
||||
status = MRAA_ERROR_NO_RESOURCES;
|
||||
fprintf(stdout, "Could not initialize i2c\n");
|
||||
goto i2c_set_exit;
|
||||
}
|
||||
status = mraa_i2c_address(i2c, device_address);
|
||||
if (status != MRAA_SUCCESS) {
|
||||
fprintf(stdout, "Could not set i2c device address\n");
|
||||
goto i2c_set_exit;
|
||||
}
|
||||
status = mraa_i2c_write_byte_data(i2c, data, register_address);
|
||||
if (status != MRAA_SUCCESS) {
|
||||
fprintf(stdout, "Could not write to i2c register. Status = %d\n", status);
|
||||
goto i2c_set_exit;
|
||||
}
|
||||
/*
|
||||
status = mraa_i2c_write_byte(i2c, data);
|
||||
if (status != MRAA_SUCCESS) {
|
||||
fprintf(stdout, "Could not set value. Status = %d\n", status);
|
||||
goto i2c_set_exit;
|
||||
}
|
||||
*/
|
||||
i2c_set_exit:
|
||||
if (i2c != NULL)
|
||||
mraa_i2c_stop(i2c);
|
||||
return status;
|
||||
}
|
||||
|
||||
|
||||
void i2c_detect_devices(int bus)
|
||||
{
|
||||
mraa_result_t status = MRAA_SUCCESS;
|
||||
mraa_i2c_context i2c = mraa_i2c_init(bus);
|
||||
int addr;
|
||||
for (addr=0x0; addr < 0x80; ++addr) {
|
||||
uint8_t value;
|
||||
if ((addr) % 16 == 0)
|
||||
printf("%02x: ", addr);
|
||||
if (i2c_get(bus, addr, 0, &value) == MRAA_SUCCESS)
|
||||
printf("%02x ", addr);
|
||||
else
|
||||
printf("-- ", addr);
|
||||
if ((addr + 1) % 16 == 0)
|
||||
printf("\n");
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
|
||||
int
|
||||
main(int argc, char** argv)
|
||||
{
|
||||
mraa_set_log_level(7);
|
||||
if (argc == 1) {
|
||||
print_command_error();
|
||||
}
|
||||
|
||||
if (argc > 1) {
|
||||
if (strcmp(argv[1], "help") == 0) {
|
||||
print_help();
|
||||
} else if (strcmp(argv[1], "version") == 0) {
|
||||
print_version();
|
||||
} else if (strcmp(argv[1], "list") == 0) {
|
||||
print_busses();
|
||||
} else if (strcmp(argv[1], "detect") == 0) {
|
||||
if (argc == 3) {
|
||||
int bus = strtol(argv[2], NULL, 0);
|
||||
i2c_detect_devices(bus);
|
||||
} else {
|
||||
print_command_error();
|
||||
}
|
||||
} else if ((strcmp(argv[1], "get") == 0)) {
|
||||
if (argc == 5) {
|
||||
int bus = strtol(argv[2], NULL, 0);
|
||||
uint8_t device_address = strtol(argv[3], NULL, 0);
|
||||
uint8_t register_address = strtol(argv[4], NULL, 0);
|
||||
// fprintf(stdout, "Device %02X, Register = %02X\n", device_address, register_address);
|
||||
uint8_t data;
|
||||
if (i2c_get(bus, device_address, register_address, &data) == MRAA_SUCCESS) {
|
||||
fprintf(stdout, "Register %#02X = %#02X\n", register_address, data);
|
||||
} else {
|
||||
fprintf(stdout, "i2c get failed\n");
|
||||
}
|
||||
} else {
|
||||
print_command_error();
|
||||
}
|
||||
} else if ((strcmp(argv[1], "set") == 0)) {
|
||||
if (argc == 6) {
|
||||
int bus = strtol(argv[2], NULL, 0);
|
||||
uint8_t device_address = strtol(argv[3], NULL, 0);
|
||||
uint8_t register_address = strtol(argv[4], NULL, 0);
|
||||
uint8_t value = strtol(argv[5], NULL, 0);
|
||||
fprintf(stdout, "Device %02X, Register = %02X, Value = %02X\n", device_address, register_address, value);
|
||||
if (i2c_set(bus, device_address, register_address, value) != MRAA_SUCCESS) {
|
||||
fprintf(stdout, "i2c set failed\n");
|
||||
}
|
||||
} else {
|
||||
print_command_error();
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user