csu3_am335x/EVSE/Modularization/DcMeter/Module_DcMeter.c

/*
 * Module_DcMeter.c
 *
 *  Created on: 2021/5/31
 *      Author: foluswen
 */
#include "Module_DcMeter.h"
#include "meterComm.h"

/**
 * Initial share memory
 * @return
 */
int InitShareMemory()
{
	int result = PASS;
	int MeterSMId;

	//Initialize ShmSysConfigAndInfo
	if ((MeterSMId = shmget(ShmSysConfigAndInfoKey, sizeof(struct SysConfigAndInfo),  0777)) < 0)
    {
		DEBUG_ERROR("shmget ShmSysConfigAndInfo NG\n");
		result = FAIL;
	}
    else if ((ShmSysConfigAndInfo = shmat(MeterSMId, NULL, 0)) == (void *) -1)
    {
    	DEBUG_ERROR("shmat ShmSysConfigAndInfo NG\n");
    	result = FAIL;
   	 }
    else
    {}

   	//Initialize ShmStatusCodeData
   	if ((MeterSMId = shmget(ShmStatusCodeKey, sizeof(struct StatusCodeData),  0777)) < 0)
    {
   		DEBUG_ERROR("shmget ShmStatusCodeData NG\n");
   		result = FAIL;
	}
    else if ((ShmStatusCodeData = shmat(MeterSMId, NULL, 0)) == (void *) -1)
    {
    	DEBUG_ERROR("shmat ShmStatusCodeData NG\n");
    	result = FAIL;
   	}
    else
    {}

    return result;
}

//==========================================
// Main loop
//==========================================
int main(void)
{
	Meter_Info meter_info;
	uint8_t pollingIndex = 0;
	uint8_t failCount = 0;

#ifndef DEBUG_STANDALONG
	// Initialize share memory
	if(InitShareMemory() == FAIL)
	{
		DEBUG_ERROR("InitShareMemory NG\n");

		if(ShmStatusCodeData!=NULL)
		{
			ShmStatusCodeData->AlarmCode.AlarmEvents.bits.FailToCreateShareMemory=ON;
		}
		sleep(5);
		return -1;
	}
#endif//DEBUG_STANDALONG

	// Initialize DC meter model
	/*
	 *	TODO:
	 *		1. Maybe need to parse configuration by model name
	 */
	meterInitialize(METER_MODEL_LEM_L18005A);

	// Main loop
	for(;;)
	{
		switch(pollingIndex)
		{
			case 0:
				if(readCurrent(&meter_info))
				{
#ifndef DEBUG_STANDALONG
					/*
					 *	TODO:
					 *		1. Synchronize data to share memory
					 */
#else
					DEBUG_INFO("Output current: %.3f A\n", meter_info.presentCurrent);
#endif//DEBUG_STANDALONG
					pollingIndex++;
					failCount = 0;
				}
				else
				{
					if(failCount < 10)
						failCount++;
				}
				break;
			case 1:
				if(readVoltage(&meter_info))
				{
#ifndef DEBUG_STANDALONG
					/*
					 *	TODO:
					 *		1. Synchronize data to share memory
					 */
#else
					DEBUG_INFO("Output voltage: %.3f V\n", meter_info.presetVoltage);
#endif//DEBUG_STANDALONG
					pollingIndex++;
					failCount = 0;
				}
				else
				{
					if(failCount < 10)
						failCount++;
				}
				break;
			case 2:
				if(readPower(&meter_info))
				{
#ifndef DEBUG_STANDALONG
					/*
					 *	TODO:
					 *		1. Synchronize data to share memory
					 */
#else
					DEBUG_INFO("Output power: %.3f kw\n", meter_info.presentPower);
#endif//DEBUG_STANDALONG
					pollingIndex++;
					failCount = 0;
				}
				else
				{
					if(failCount < 10)
						failCount++;
				}
				break;
			case 3:
				if(readEnergy(&meter_info))
				{
#ifndef DEBUG_STANDALONG
					/*
					 *	TODO:
					 *		1. Synchronize data to share memory
					 */
#else
					DEBUG_INFO("Totalize import energy: %.3f kwh\n", meter_info.totlizeImportEnergy);
					DEBUG_INFO("Totalize export energy: %.3f kwh\n", meter_info.totlizeExportEnergy);
#endif//DEBUG_STANDALONG
					pollingIndex++;
					failCount = 0;
				}
				else
				{
					if(failCount < 10)
						failCount++;
				}
				break;
			default:
				pollingIndex = 0;
				break;
		}

		if(failCount >= 10)
		{
#ifndef DEBUG_STANDALONG
			if(ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout)
			{
				DEBUG_ERROR("Meter communication timeout");
				ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout = ON;
			}
#endif//DEBUG_STANDALONG
		}
		else
		{
#ifndef DEBUG_STANDALONG
			ShmStatusCodeData->AlarmCode.AlarmEvents.bits.MeterCommTimeout = OFF;
#endif//DEBUG_STANDALONG
		}

		usleep(500000);
	}

	return -1;
}