Can_open_masternode

Dependencies:   mbed

source/port_helper.cpp

Committer:
sam_grove
Date:
2011-05-30
Revision:
0:9dd7c6129683
Child:
1:cb8989598a0f

File content as of revision 0:9dd7c6129683:



#include "port_helper.h"
#include "main.h"

Serial Debug(USBTX, USBRX);
DigitalOut running_status(LED1);

extern uint8_t nodeID;
extern uint8_t change_node_id;
extern NMTStateAdjustment stack_state;

void initHelper()
{
	Debug.baud(57600);
	printf(" CANopen port of CANfestival master node \n");
}

void serviceHelper()
{
	static uint32_t cnt = 0;
	// indicate that the stack is running
	if (cnt++ > 100){
		cnt = 0;
		running_status = !running_status;
	}	
}


void printMsg(Message& msg)
{
	CANMessage m(msg.cob_id, (char*)msg.data, msg.len, static_cast<CANType>(msg.rtr), CANStandard);
	// call the CANMessage formatted method
	printMsg(m);
}

void printMsg(CANMessage& msg)
{
	printf("ID: 0x%04X DLC: %d Data(0->7): 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X 0x%02X\n",
		msg.id, msg.len, msg.data[0], msg.data[1], msg.data[2], 
		msg.data[3], msg.data[4], msg.data[5], msg.data[6],msg.data[7]);
}

void serviceCOMCommands()
{
 	static char msg[64];
	static char w_loc=0;
	if (Debug.readable()){
		// store the data
		if (w_loc < 64){
			msg[w_loc++] = Debug.getc();
		}
		// clear the buffer and try again
		else{
			// clear the buffer
			memset(msg, 0, 64);
			w_loc = 0;
			return;
		}
		// parse the message and act on it
		if ((msg[w_loc-1] == '\r') || (msg[w_loc-1] == '\n') ){
			// format the message
			// process the message and look for something familiar
			if (strncmp(msg, "help", strlen("help")) == 0){
			 	// print the help menu
				printf("\t HELP OPTIONS (case sesnitive):\n");
				printf("\t  help - display the available options\n");
				printf("\t  id=xxx - change the node id\n");
				printf("\t  about - get info about the node\n");
				printf("\t  state=xxxx - start, stop, reset\n");
			}
			else if (strncmp(msg, "id=", strlen("id=")) == 0){
				// change the node ID
				int res = atoi(msg+strlen("id="));
				if ( (res > 0) && (res < 128) ){
					nodeID = res;
					printf("the new node_id = %d\n", nodeID);
					change_node_id = 1;
				}
				else{
					printf("invalid parameter");
				}
			}
			else if (strncmp(msg, "about", strlen("about")) == 0){
				// our call tag
				printf(" CANopen port of CANfestival master node \n");
			}
			else if (strncmp(msg, "state=", strlen("state=")) == 0){
				// ohh what to do
				if (strncmp(msg+strlen("state="), "start", strlen("start")) == 0){
					printf("stack state = start");
					// signal back
					stack_state = start;
				}
				else if (strncmp(msg+strlen("state="), "stop", strlen("stop")) == 0){
				 	printf("stack state = stop");
					// signal back
					stack_state = stop;
				}
				else if (strncmp(msg+strlen("state="), "reset", strlen("reset")) == 0){
				 	printf("stack state = reset");
					// signal back
					stack_state = reset;
				}
			}
			// clear the buffer
			memset(msg, 0, 64);
			w_loc = 0;
		}
	}
}

/*
WDT_IRQHandler           
TIMER0_IRQHandler         
TIMER1_IRQHandler         
TIMER2_IRQHandler         
TIMER3_IRQHandler         
UART0_IRQHandler          
UART1_IRQHandler          
UART2_IRQHandler          
UART3_IRQHandler          
PWM1_IRQHandler           
I2C0_IRQHandler           
I2C1_IRQHandler           
I2C2_IRQHandler           
SPI_IRQHandler            
SSP0_IRQHandler           
SSP1_IRQHandler           
PLL0_IRQHandler           
RTC_IRQHandler            
EINT0_IRQHandler          
EINT1_IRQHandler          
EINT2_IRQHandler          
EINT3_IRQHandler          
ADC_IRQHandler            
BOD_IRQHandler            
USB_IRQHandler            
CAN_IRQHandler            
DMA_IRQHandler          
I2S_IRQHandler            
ENET_IRQHandler       
RIT_IRQHandler          
MCPWM_IRQHandler             
QEI_IRQHandler            
PLL1_IRQHandler           
USBActivity_IRQHandler
CANActivity_IRQHandler
*/