Trikarus/firmware_smartstepper_trikarus/stepper_nano_zero/syslog.cpp

/*
 * syslog.c
 *
 *  Created on: Sep 14, 2011
 *      Author: trampas.stern
 *
	Copyright (C) 2018  MisfitTech,  All rights reserved.

    This program is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License.

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program.  If not, see <https://www.gnu.org/licenses/>.

    Written by Trampas Stern for MisfitTech.

    Misfit Tech invests time and resources providing this open source code,
    please support MisfitTech and open-source hardware by purchasing
	products from MisfitTech, www.misifittech.net!
 *********************************************************************/
#include "syslog.h"
#include <Arduino.h>
#include "board.h"


#define ANSI_WHITE 		"\033[37m"
#define ANSI_NORMAL 	"\033[0m"
#define ANSI_BLINK 		"\033[5m"
#define ANSI_BLUE 		"\033[34m"
#define ANSI_MAGENTA 	"\033[35m"
#define ANSI_CYAN 		"\033[36m"
#define ANSI_WHITE 		"\033[37m"
#define ANSI_RED 		"\033[31m"
#define ANSI_GREEN 		"\033[32m"
#define ANSI_PINK 		"\033[35m\033[1m"
#define ANSI_BROWN 		"\033[33m"
#define ANSI_YELLOW 	"\033[33m\033[1m"
#define ANSI_BLACK      "\033[30m"
#define ANSI_BELL_AND_RED 		"\a\033[31m"

#define NEW_LINE "\n\r"

Stream *ptrSerial=NULL;
eLogLevel SyslogLevelToWrite;

bool DebugUART=false;
static char buffer[SYSLOG_BUFFER_SIZE];
static unsigned int BufIndex=0;

static int SysLog_Enabled=1;

int SysLogDisable(void)
{
	SysLog_Enabled=0;
	return 0;
}

int SysLogEnable(void)
{
	SysLog_Enabled=1;
	return 0;
}

int SysLogIsEnabled(void)
{
	return SysLog_Enabled;
}
void SysLogDebug(bool x)
{
	DebugUART=x;
}

void SysLogPuts(const char *ptrStr)
{
	if (!SysLog_Enabled)
		return;

	if (NULL == ptrSerial)
	{
		while(*ptrStr)
		{

			SYSLOG_PUTC(*ptrStr);
			ptrStr++;
		}
	} else
	{
		ptrSerial->write(ptrStr);
	}
#ifndef MECHADUINO_HARDWARE 
	if (DebugUART)
	{
		SerialUSB.write(ptrStr);
	}
#endif
}

int SysLogInitDone=0;
void SysLogInit(Stream *ptrSerialObj, eLogLevel LevelToWrite)
{
	ptrSerial=ptrSerialObj;
	SyslogLevelToWrite=LevelToWrite;

	SysLogInitDone=1;
	BufIndex=0;
	memset(buffer,0,SYSLOG_BUFFER_SIZE);
}


int SysLogProcessing=0; // this is used such that syslog can be reentrent
int SysLogMissed=0;


void SysLog(eLogLevel priorty, const char *fmt, ...)
{
    //UINT32 ret;
	int previousState=SysLog_Enabled;
    char vastr[MAX_SYSLOG_STRING]={0};
    //char outstr[MAX_SYSLOG_STRING]={0};


    va_list ap;

    if (SysLogProcessing)
    {
    	//we have a syslog from a syslog call thus return as not much we can do...
    	//memset(buffer,0,SYSLOG_BUFFER_SIZE);
    	va_start(ap,fmt);
    	vsnprintf(&buffer[BufIndex],SYSLOG_BUFFER_SIZE-BufIndex,(char *)fmt,ap);
    	BufIndex=strlen(buffer);
    	snprintf(&buffer[BufIndex],SYSLOG_BUFFER_SIZE-BufIndex,NEW_LINE);
    	BufIndex=strlen(buffer);
    	SysLogMissed++; //set flag that we missed a call
    	return;
    }

    SysLogProcessing=1;

    //stop the watch dog will doing a SysLog print
    Sys_WDogHoldOn();

    if(!SysLogInitDone)
    {
    	SysLogInit(NULL, LOG_WARNING); //not sure who is reseting serial port but before we print set it up
        WARNING("You should init SysLog");
    	//SysLogInitDone=0;
    }

    //Send out a * that we missed a SysLog Message before this current message
    if (SysLogMissed)
    {
    	//SysLogPuts(ANSI_RED);
    	SysLogPuts("*** Reentrant Log call possible loss of message(s):");
    	SysLogPuts(NEW_LINE);
    	if (BufIndex>0)
    	{
    		SysLogPuts(buffer);
    		memset(buffer,0,SYSLOG_BUFFER_SIZE);
    		BufIndex=0;
    	}
    	//SysLogPuts(ANSI_RED);
    	SysLogPuts("***********");
    	SysLogPuts(NEW_LINE);
    	SysLogMissed=0;
    }
    memset(vastr,0,MAX_SYSLOG_STRING);
    va_start(ap,fmt);
//#ifndef PGM_P
#if 1
   vsnprintf(vastr,MAX_SYSLOG_STRING,(char *)fmt,ap);
#else
    vsprintf_P(vastr,(const char *)fmt,ap);
#endif
    //get time and store in datetimestr if desired
    //sprintf(outstr, "[%s] %s\r\n", datetimestr, vastr);



    if (priorty<=LOG_ERROR)
    {
    	SysLog_Enabled=1;
    	SysLogPuts(ANSI_RED);

    }else if (priorty==LOG_DEBUG)
    {
    	SysLogPuts(ANSI_WHITE);
    }else if (priorty==LOG_WARNING)
    {
    	SysLogPuts(ANSI_BLUE);
    }

#ifdef RTC_H_
#ifdef TIME_H_
    {
    	struct tm tp;
    	RTC_Time_s tm;
    	time_t secs;
    	char datetimestr[MAX_SYSLOG_STRING]={0};

    	RTC_ReadTime(&tm);
    	secs=tm.seconds;
    	convertFlexNetTime((time_t *)&secs, &tp);
    	time_str(datetimestr,&tp);
    	SysLogPuts(datetimestr);

    	if (priorty<=SyslogLevelToWrite && SysLogWriteFunc!=NULL)
		{
			SysLogWriteFunc(datetimestr,strlen(datetimestr));
		}
    }
#endif
#endif

    SysLogPuts(vastr);
//
//    if (priorty<=SyslogLevelToWrite && SysLogWriteFunc!=NULL)
//    {
//    	SysLogWriteFunc(vastr,strlen(vastr));
//    	SysLogWriteFunc(NEW_LINE,strlen(NEW_LINE));
//    }


    SysLogPuts(ANSI_NORMAL);
    SysLogPuts(NEW_LINE);



    if (priorty == LOG_EMERG) {
    	//you can reboot processor here
    }

    //start the watch dog where left off..
    Sys_WDogHoldOff();
    SysLogProcessing=0;
    SysLog_Enabled=previousState;
    return;
}