debug_ina232.cpp

#include "debug_ina232.h"
#include "FreeRTOS.h"
#include "FreeRTOS_CLI.h"
#include <string.h>
#include <stdlib.h>
#include "debug.h"
#include "cli.h"
#include <stdlib.h>

static INA232** _ina232_devices = NULL;
static uint8_t _num_ina_devices = 0;

static BaseType_t ina232Command( char *writeBuffer,
                                  size_t writeBufferLen,
                                  const char *commandString);

static const CLI_Command_Definition_t cmdINA232 = {
  // Command string
  "ina",
  // Help string
  "ina:\n"
  " * ina list - list all available ina232's\n"
  " * ina <dev_id> init - initialize and configure\n"
  " * ina <dev_id> pow - get latest power measurement\n"
  " * ina <dev_id> conv - get total conversion time\n",
  // Command function
  ina232Command,
  // Number of parameters
  -1
};


void debugINA232Init(INA232 **ina232_devs, uint8_t num_ina_dev) {
  _ina232_devices = ina232_devs;
	_num_ina_devices = num_ina_dev;
  FreeRTOS_CLIRegisterCommand( &cmdINA232 );
}

static BaseType_t ina232Command( char *writeBuffer,
                                  size_t writeBufferLen,
                                  const char *commandString) {
	BaseType_t parameterStringLength;

	( void ) writeBuffer;
	( void ) writeBufferLen;

	do {
		if(!_ina232_devices){
			printf("debugINA232 not initialized\n");
			break;
		}
		const char *parameter = FreeRTOS_CLIGetParameter(
			commandString,
			1,
			&parameterStringLength);
		if(parameter == NULL){
			printf("ERR Invalid paramters\n");
			break;
		}
		if(strncmp("list", parameter, parameterStringLength) == 0){
			for(uint8_t count = 0; count < _num_ina_devices; count ++){
				printf("ina: %u\n", count);
			}
			break;
		}
		uint8_t dev_id = atoi(parameter);
		if(dev_id >= _num_ina_devices) {
			printf("ERR Invalid paramters\n");
			break;
		}
		const char *ina_command = FreeRTOS_CLIGetParameter(
			commandString,
			2,
			&parameterStringLength);
		if(ina_command == NULL){
			printf("ERR Invalid paramters\n");
			break;
		}
		if (strncmp("init", ina_command, parameterStringLength) == 0){
			if(_ina232_devices[dev_id]->init()){
				// set shunt to 10mOhms
				_ina232_devices[dev_id]->setShuntValue(0.01);

				//Set normal sampling speed
				_ina232_devices[dev_id]->setBusConvTime(CT_1100);
				_ina232_devices[dev_id]->setShuntConvTime(CT_1100);
				_ina232_devices[dev_id]->setAvg(AVG_256);
				printf("ina %u initialized\n", dev_id);
			} else {
				printf("Failed to initialize ina %u\n", dev_id);
			}
		} else if(strncmp("pow", ina_command, parameterStringLength) == 0){
			if(!_ina232_devices[dev_id]->measurePower()){
				printf("Failed to measure power!\n");
				break;
			}
			float _voltage = 0;
			float _current = 0;
			_ina232_devices[dev_id]->getPower(_voltage, _current);
			printf("Bus Voltage: %f\n", _voltage);
			printf("Bus Current: %f\n", _current);
			printf("Bus Power: %f\n", _current*_voltage);
		} else if (strncmp("conv", ina_command, parameterStringLength) == 0){
			// get the total conversion time and print it out
			uint32_t convTime = _ina232_devices[dev_id]->getTotalConversionTimeMs();
			printf("Total Conversion Time Ms: %" PRIu32 "\n", convTime);
		} else {
			printf("ERR Invalid paramters\n");
			break;
		}
	} while(0);
	return pdFALSE;
}