Added SYSSTOP & MSTATE macro

New example main.c

1 files changed, 65 insertions, 2 deletions

diff --git a/rs422lib/main.c b/rs422lib/main.c
index 2a2517f..34cb03e 100644
--- a/rs422lib/main.c
+++ b/rs422lib/main.c
@@ -4,6 +4,7 @@
 #include"sysctl.h"
 
 int cnt=0;
+int cnt2=0;
 
 void port_init(void)
 {
@@ -13,7 +14,52 @@ void port_init(void)
 
 void received(unsigned char* str,unsigned int len)
 {
-	rsbus_w(0,str,len);
+	unsigned char ch;
+	switch (str[0])
+	{
+	case 1:// start
+		if (!MSTATE)
+		{
+			SWITCH_STATE(ST_RUN);
+			cnt2=0;
+			STATE(0)=0;
+			SYSCALL(TEST);
+		}
+		RETSTATE;
+		break;
+	case 2:// Get Res
+		if (MSTATE&ST_RUN)
+		{
+			ch=(unsigned char)(cnt2-STATE(0));
+			rsbus_w(0,&ch,1);
+		}
+		else
+		if (MSTATE&ST_RES)
+		{
+			SWITCH_STATE(ST_REST);
+			ch=(unsigned char)(cnt2);
+			rsbus_w(0,&ch,1);
+		}
+		else
+			RETSTATE;
+		break;
+	case 3:// Stop
+		if (MSTATE&ST_RUN)
+		{
+			SWITCH_STATE(ST_REST);
+			SYSSTOP(TEST);
+		}
+		RETSTATE;
+		break;
+	case 4:// Block
+		if (!MSTATE)
+		{
+			cnt2=0;
+			SWITCH_STATE(ST_BUSY);
+		}
+		RETSTATE;
+	}
+	//rsbus_w(0,str,len);
 }
 
 // Timer A0 interrupt service routine
@@ -24,13 +70,19 @@ __interrupt void Timer_A0 (void)
 	if (cnt==25)
 	{
 		STATE(0)=(STATE(0)+1)&0xFF;
+		if ((MSTATE&ST_BUSY) && !(MSTATE&ST_RES))
+		{
+			++cnt2;
+			if (STATE(0)>200)
+				SWITCH_STATE(ST_BUSY|ST_RES);
+		}
 		cnt=0;
 		P1OUT^=BIT6;
 	}
 }
 
 //TIMER A0 initialize -
-// desired value: 5ms
+// desired value: 40ms
 void TimerA0_Init(void)
 {
 	// Configure TimerA0
@@ -60,9 +112,20 @@ void init_devices(void)
 	_BIS_SR(GIE);
 }
 
+// Clock tick using cycle estimation
+void basic_running_ex()
+{
+	int i;
+	for (i=950;i>0;--i)
+		delay_ms(1);
+	++cnt2;
+	SYSCALL(TEST);
+}
+
 void main(void)
 {
 	init_devices();
+	sysctl_reghdlr(TEST,basic_running_ex);
 	while(1)
 		sysroutine();
 }