From 19f5e541eefc0f6652abfc61179b50594d3509d5 Mon Sep 17 00:00:00 2001
From: liyating <liyating@ccsens.com>
Date: Fri, 31 Dec 2021 18:42:39 +0800
Subject: [PATCH] =?UTF-8?q?=E8=AE=A4=E8=AF=81=E5=8C=85ok?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 si4/ps5ws.si4project/soft_ps5ws.sip_sym | Bin 466352 -> 466352 bytes
 source/app/app_config.c                 |  27 +++----
 source/app/app_config.h                 |   4 +-
 source/app/app_task_tcp.c               |   4 +-
 source/app/app_task_tcp_control.c       |  16 ++---
 source/app/main.c                       |  16 +++--
 source/app/task_pen_head.c              |  90 ++++++++++++++++++++----
 source/app/task_pen_head.h              |  16 +++--
 source/clib/clib.c                      |   2 +-
 source/clib/clib.h                      |   2 +-
 source/ctask/tick.h                     |   1 +
 source/tpc/ccmodbus.c                   |   3 +-
 12 files changed, 125 insertions(+), 56 deletions(-)

diff --git a/si4/ps5ws.si4project/soft_ps5ws.sip_sym b/si4/ps5ws.si4project/soft_ps5ws.sip_sym
index b5284a5ab6d4687101235d1e6c2c7a28b9a208d1..bd5b0ed472d8d8d5b38ecf6079f05c1c84643ebd 100644
GIT binary patch
delta 1670
zcmaJ?VQf=X6n^*hp0`)l##h?%78vAJo?*nPBf|h%MoU&f22!?3ra{_;k${4$b8!TX
zZrxz8pq5?SLBo&XFeb{6k}j46G+V-tMKl=+DuKZ^93qNI5!C%K;<+8-4+1y&-Z}T2
zbI&>VoO9dsiQ@E$V!yvYQC?CMe%h%h#nTieqbo}PvA`%3!$*w_S1pGaIKr{?Y1N1N
zBGn~ULN7~+YtSd+pK%iuML9%}>th1TLld8BA9}tdo)aXM>#SH;(1&F^HSU(;zPwOT
zPG&$~=47)(+Y^gK*>s+1^$e-qDmQ1ZE{`?Wzy3-rvH8{5md*7Iv6iN-&6_d23znb}
zVMbw?TuenY&`d%=l+G&A^oIK8`UDPo3RVfL$cJY)frshh(u|5szkdr;*~|L_&-F9{
zcRT2~Nyt+S9M`<;I}9Yji_s1!6~ks!MEyQ-V7ehvW+>B9bV_&13(qG24lV~%#OLzN
zw!q1<o*NAC;^#2UxiS*2j8%qf!}|k43~hAS>Kp~T+Mz;>Rc~=Plt<dDYO+-|tSwS_
zf&9qy3zWx2qw3FIKgj+L<JnPWWGBzFfj0`b-!V{>hou3YTc>u2(0fy5Zz82!9}%P%
zhZ5*)sa6RN0?)Qo!zZ?guLo~!ZB0$AHe6E`yPF)w8`PkPHrndUsq7wDZDB=x>=}G^
zH_Q_oA|;r52cl@4aB$4c)Aa1b4$v94{=h+8T)ehtu4XWg2sC)r3r@VW7b-BG1Q$l<
ztCb#E>Y4du?@+NI;>A7f;LFz>d*20Jm;IKl7UOe5m`;*z;dy4@H*b=c(j@44Q*+jR
z#-r_uwj|$P7sZk7r3qKed>mIN`P#M{O7D%+ZE;V44E==v=mI>}2`2hFVKEL*z%=$G
z=0>3sV?hAS^{EzX#ldk{CT>~L?)6-x*IGE-0vr!?K`=Y=HWaJg;(M}e!irt66ceMG
zQM7@g$=)$#27RZN>?<bPAV>q_bl;u*CVBu!cY8{Vxj3$F0~hn)nbVpVSMHdq%fbhi
z1k+}LQ7CI71IhtDorKxg+6G)qI!e&jPCbn;Q*F`ebm4(^=)gn^xIlJn1|D8QuOiq1
zx9)$TVUuodYyx9;Bp=}a&w1*=Keun+mRKs*Mau7UGi*J>U1BVvW5*iRV5jhf-B6XE
z8<AVV-LfsROnHjqGgUA98r_}nz8F}=owCb?gaRC#tC{Za@5KC;=u&ZbV|mXWi1vKN
zI3~Klz=l20D^hE?7>OCeUSwd&UP#Hxy6JaNaTD?sUpvmcI6^wy_oC(#N7fkGR2Lk1
z9z)BSjdf$B7(2}DtZN)98O9$18=Eha(7LJFSn?zJq&J2m#NgOf5~U`Hi=QE`@(OXe
zt8`#ea-l<%T5-Q>Wsm+uu0-fjE>h(d`hF&5;xauoV;8e<NN!UuI`!5yavoY}W7#jn
zq_^5QK@65PsvJW}W@QilDpSfOnf=9YFvM|SK(+Du4KlWxZ0!A=m|U}swKwTh^f>AC
zTO^A5Ii@F=f&3zUPD+tg#6Rc-9b|>;glE1N6MxW|bR9(+*-lB>e@d$$M@!J|oZJnx
j*tqX6Vp2QpY-kdUNjX~_<C9DW`kPU_+4`Ke_OX8fnREj`

delta 1668
zcmZ`)eQZ-z6u-B<_qC(%xd*RhW9hVw&p6_QB}@>7Z0N`qKJ;xvMN!wfjX;>vjE$iz
zFg9S*_(#XpossO1RuGLLaid^KMndEK;4|5xf1u7da1&5WilWX$#dBYqm>GS^FX!Cz
z`MYQ5c7wzI!C}A8=OW}eLfGjXLj1D`X(ogm9}0d$#pqEz!5jf6L~<F^INIMt$Zr7X
z5{DtGc#QUn>--Q{n-vBV7ZueLM>n;>#5>ACD0$DxG=_##2>E>`s$GX5a*$@sZ)L1x
zIKkazIsAy5kU4O3F@GSjYxX$@=)Y6uc7<E(HikDh^#-ei<@1VLOLY-jz(n!f2h|az
zFa6tE>+7XIkne?)gH(snJkCTz!Lr10-zMtuY;4-vR@)M8ZfS&}v-DAMXZ~DqIG{tU
z0K=;Cmx<9l%P#)L934uoQ6@?YmnZh+kGM4jDb7dOQpDF9B6K%PGzCwUWSZ!f55`*A
z!!VknrdU_&Jy26DCTcc0IVtU0U7K88OZTkwjAI2k7#CS6wmN*t8~yZ;70@!m_2l%I
zG_~EcB^y9UPzJ!IYR6uP_E455M;}4RuOA`HI7y(pt;T_HB3QDmhQDn(K61fgL#Ywz
zN(TPD+$}SS3DpDCU?1Y7`d;Q<Xdj>^`xH-5UZ7Zz+UQ_VJWo;SLl7@e3?@fv2VN*p
ziXgh1Tc8g+8Km!3+{wuu+)cGJ7?Shi)`k~aw>33FbtSKa=rLRp54L*-VM{T#%FsT>
z$iHsizAeFFY=kakXJzZiF=}OU3bQ%3gkDuKG)eAXN#|tJvwp?GzcAChnDZ3EmUa$Y
z*vVCz?QmWO>xCF>`7*)lv%%{#4J3t`4U`LLQX_ErF6A*uzfW<UV~U&022W=isNMfG
zxQM|bRiC}VJPeYzwk5<*P(zapW;SpqaJ8M=!??w3?2G3FvuQyX@+o<mBrqdoQF442
z_d90ityxsp65h6@F4Fi?-KNHHgGiT^i3yeUb#m3?$0~9m2+4)rUAz!F_VD66d^2+3
z^d7#vw}gXL=wgui6EBhjW9JovjzO@KmqGu2u8NzX3V3%X_lnY$I(*)Vn=-MJ7lXHp
zTcSM7#B^x@^3e|iUA$eyHZaYJT~&lFA-<Fwuxu~C_1}ykbb_f6b17~yd7locZtjMj
zcCJHc2QT^`!Uvx8LIri{P_={SLu5ZMwOOV^oN01=vk|t0%LNVtI@*z4pc~ogvzUhS
zB>1C-FOCph3@tFUFR~;43eC$!{P{(FJ$Sd+1}`-9@R%H_2-WMtT%tqKt2`=FtC%J$
z$aS`*2>T2eM;BN<IH<#G^<?xle)tIyyN5w^1r5OZ33LXgxS3Qh^9l;-PHIBS6*Pu&
zxd}zzqBe0=F=5=+;^>V|VyliO6Dp=;ZU>sCrB?n3HIqlb!zz8v_(atsjsSSCNyh-L
zr~fz}&&Xr?Di&_Pj#}gjK2v=k(kS^Jk5LsJlc<UEQZw2A16C4)o6Qe?<Y$-&G@Eea
zCPsxmahMSM2{r2^YU_UH(Y{{f;JziDQ`8IWYpTO3Jj%BRgOgMj-uXI2enCt06%))~
sQAxF#a0wOAr|@>K|AtyLg<~k6=K8dVu4Nkjb0N71TPDM4<?;Lf25G4dApigX

diff --git a/source/app/app_config.c b/source/app/app_config.c
index 9d74fbc..b7c64be 100644
--- a/source/app/app_config.c
+++ b/source/app/app_config.c
@@ -28,7 +28,7 @@ void L3_param_init(void)
 	Lc_strcpy(G.ap_pwd,"ccsens123");
 	
 	wr_buf.wIndex = wr_buf.rIndex = 0;
-	wr_buf.maxsize = POINT_LEN;
+	wr_buf.maxsize = sizeof(wr_buf.buf)/sizeof(PenPoint);
 	for(i=0;i<wr_buf.maxsize;i++)
 	{
 		wr_buf.buf[i].time = wr_buf.buf[i].x_axis = wr_buf.buf[i].y_axis = 0;
@@ -131,16 +131,15 @@ void L3_reg_reset(void)
 	G.ccmd_slaver_info[2].oper = MODBUS_OPER_WRITE_M;
 	G.ccmd_slaver_info[2].reg = 0x20;
 	G.ccmd_slaver_info[2].regnum = 0x03;//基础数量，程序每次应动态添加点数
-	G.ccmd_slaver_info[2].bytes = G.ccmd_slaver_info[2].regnum * 2;
+	G.ccmd_slaver_info[2].bytes = 0;
 	G.ccmd_slaver_info[2].buf = (U8*)&R.pack_order;
 	G.ccmd_slaver_info[2].mask = 0;	
-	G.ccmd_slaver_info[2].extra_num =0; 
+	G.ccmd_slaver_info[2].extra_num = 0; 
 
 	G.modbusstmp = 0;
 	G.authed = 0;
-	G.flowStarted = 0;
 	G.flowStartVal = 1;
-
+	G.pen_up = 0;
 	
 	
 }
@@ -158,7 +157,9 @@ void L3_reg_init(void)
 void Lc_buf_full(WR_Buf *p)
 {
 	if((p->rIndex+1)%(p->maxsize) == p->wIndex)
+	{
 		p->full = 1;
+	}
 }
 U16 Lc_write_cyc_buf(PenPoint *wbuf ,WR_Buf *wp ,U16 wlen)
 {
@@ -168,16 +169,16 @@ U16 Lc_write_cyc_buf(PenPoint *wbuf ,WR_Buf *wp ,U16 wlen)
 		wp->readdr = (wp->wIndex +  wlen) % wp->maxsize;
 		if(wp->readdr > wp->wIndex || wp->readdr == 0)
 		{
-			Lc_buf_copy_uc((U8 *)&wp->buf[wp->wIndex], (U8 *)wbuf, wlen);
+			Lc_buf_copy_uc((U8 *)&wp->buf[wp->wIndex], (U8 *)wbuf, wlen*sizeof(PenPoint));
 		}
 		else
 		{
 			wp->relen =  wlen - wp->readdr;
-			Lc_buf_copy_uc((U8 *)&wp->buf[wp->wIndex], (U8 *)wbuf, wp->relen);
-			Lc_buf_copy_uc((U8 *)&wp->buf[0], (U8 *)(wbuf+wp->relen), wp->readdr);
+			Lc_buf_copy_uc((U8 *)&wp->buf[wp->wIndex], (U8 *)wbuf, wp->relen*sizeof(PenPoint));
+			Lc_buf_copy_uc((U8 *)&wp->buf[0], (U8 *)(wbuf+wp->relen), wp->readdr*sizeof(PenPoint));
 		}
 		wp->wIndex = wp->readdr;
-		return sizeof(wbuf);
+		return wlen;
 	}
 	else
 	{
@@ -194,16 +195,16 @@ U16 Lc_read_cyc_buf(PenPoint *rbuf ,WR_Buf *rp ,U16 rlen)
 		rp->readdr = (rp->rIndex + rlen) % rp->maxsize;
 		if(rp->readdr < rp->wIndex || rp->readdr == 0)
 		{
-			Lc_buf_copy_uc((U8 *)rbuf, (U8 *)&rp->buf[rp->rIndex],rlen);
+			Lc_buf_copy_uc((U8 *)rbuf, (U8 *)&rp->buf[rp->rIndex],rlen*sizeof(PenPoint));
 		}
 		else
 		{
 			rp->relen = rlen - rp->readdr;
-			Lc_buf_copy_uc((U8 *)rbuf,(U8 *) &rp->buf[rp->rIndex], rp->relen);
-			Lc_buf_copy_uc((U8 *)(rbuf+rp->relen), (U8 *)&rp->buf[0], rp->readdr);
+			Lc_buf_copy_uc((U8 *)rbuf,(U8 *) &rp->buf[rp->rIndex], rp->relen*sizeof(PenPoint));
+			Lc_buf_copy_uc((U8 *)(rbuf+rp->relen), (U8 *)&rp->buf[0], rp->readdr*sizeof(PenPoint));
 		}
 		rp->rIndex = rp->readdr;
-		return sizeof(rbuf);
+		return rlen;
 	}
 	else
 	{
diff --git a/source/app/app_config.h b/source/app/app_config.h
index d0a91a8..beb6e7a 100644
--- a/source/app/app_config.h
+++ b/source/app/app_config.h
@@ -39,7 +39,7 @@ typedef struct global_register
 	U16 spee_order;//语音序号
 	U32 oid3_order;//序号通知（oid3普通码）
 	
-	char null[25];
+	U16 null[25];
 	
 	U16 pack_order;//包序号
 	U16 frame_order;//帧序号
@@ -85,8 +85,8 @@ typedef struct global_param
 	
 	vU32 modbusstmp;
 	U16 authed;
-	U16 flowStarted;
 	U16 flowStartVal;
+	U16 datapack;
 	U8 mcu_id[7];
 	
 	U8 pen_up;
diff --git a/source/app/app_task_tcp.c b/source/app/app_task_tcp.c
index fbdd8ae..9e8c5db 100644
--- a/source/app/app_task_tcp.c
+++ b/source/app/app_task_tcp.c
@@ -97,7 +97,7 @@ void L3_task_tcp_handle(TS_tcp *s)
 					break;
 				}
 			}
-			
+			  
 			L2_task_go(D_task_tcp_switch_next_slaver);
 		}
 		else if(s_nos_tick.t_1s - s->sendStamp >= 5)	//重发
@@ -116,7 +116,7 @@ void L3_task_tcp_handle(TS_tcp *s)
 		
 	TTSS_Task_step(D_task_tcp_switch_next_slaver)		//切换下一个
 		if(++ s->slaverIndex >= CCMD_SLAVER_INFO_MAX)
-		{
+		{		
 			s->slaverIndex = 0;
 		}
 		L2_task_go(D_task_tcp_constructor_modbus_pkg);
diff --git a/source/app/app_task_tcp_control.c b/source/app/app_task_tcp_control.c
index d2003eb..59437ba 100644
--- a/source/app/app_task_tcp_control.c
+++ b/source/app/app_task_tcp_control.c
@@ -27,7 +27,7 @@ void L3_task_tcp_control_handle(TS_tcp_control *s)//判定是否抬笔/缓冲区
 		if(s->conn_ok_pool != s_task_gm35_flow.conn_ok)
 		{	
 			G.authed = 0;
-			s->conn_ok_pool =s_task_gm35_flow.conn_ok;
+			s->conn_ok_pool =s_task_gm35_flow.conn_ok;  //s->conn_ok_pool=1
 		}
 		L2_task_go(D_task_tcp_control_02);
 	TTSS_Task_step(D_task_tcp_control_02)//是否发认证包
@@ -36,28 +36,27 @@ void L3_task_tcp_control_handle(TS_tcp_control *s)//判定是否抬笔/缓冲区
 			//3s一次发送数据包
 			if(s_nos_tick.t_1s - ts_tcp_control.tcp_send_stmp >= 3)
 			{	
-				if(!G.authed)
+				if(!G.authed)//authed == 0
 				{
 					//L0_uart0_sendstr("111");
 					//发送认证包
 					G.ccmd_slaver_info[0].mask = 1;	
-					L2_task_go(D_task_tcp_control_01);
 				}
-				else
+				else //authed == 1
 				{
-					L2_task_go(D_task_tcp_control_03);
+					G.ccmd_slaver_info[2].mask = 1;
 				}
 				ts_tcp_control.tcp_send_stmp = s_nos_tick.t_1s;
 			}
 			else if(s_nos_tick.t_1s - ts_tcp_control.tcp_send_stmp >= 60)
 			{
 				G.ccmd_slaver_info[1].mask = 1;
-				L2_task_go(D_task_tcp_control_01);
 				ts_tcp_control.tcp_send_stmp = s_nos_tick.t_1s;
 			}
+			
 		}
-		
-		
+		L2_task_go(D_task_tcp_control_01);
+	#if 0
 	TTSS_Task_step(D_task_tcp_control_03)
 		if(wr_buf.full == 1)
 		{	
@@ -72,6 +71,7 @@ void L3_task_tcp_control_handle(TS_tcp_control *s)//判定是否抬笔/缓冲区
 			G.ccmd_slaver_info[2].mask = 1;
 			L2_task_go(D_task_tcp_control_01);
 		}
+	#endif
 	TTSS_Task_end();
 }
 
diff --git a/source/app/main.c b/source/app/main.c
index 62a6eba..ff8cd22 100644
--- a/source/app/main.c
+++ b/source/app/main.c
@@ -101,7 +101,9 @@ void L0_main_init(void)
 	//w600任务初始化
 	L3_task_gm35_flow_init(W600_ST);
 	//笔头任务初始化
-	L3_task_pen_head_init();
+	L3_task_pen_head_write_init();
+	L3_task_pen_head_read_init();
+	
 	//tcp轮询任务初始化
 	L3_task_tcp_init();	
 	L3_task_tcp_control_init();
@@ -128,12 +130,12 @@ void main(void)
 		}
 
 		//WIFI 
-		L3_uart2_exp_protocol(&s_uart2_at);
-		L2_task_gm35_flow_handle(&s_task_gm35_flow);
+		//L3_uart2_exp_protocol(&s_uart2_at);
+		//L2_task_gm35_flow_handle(&s_task_gm35_flow);
 
 		//笔头数据采集
-		L3_task_pen_head_handle(&s_task_pen_head);
-
+		L3_task_pen_head_write_handle(&s_task_pen_write);
+		L3_task_pen_head_read_handle(&s_task_pen_read);
 		//寄存器值监控
 		//L3_task_reglisten_handle(&s_task_reglisten);
 
@@ -145,10 +147,10 @@ void main(void)
     	//L3_task_modbus_handler2(&s_uart2_rec);
 
 		//tcp发送
-		L3_task_tcp_handle(&ts_tcp);
+		//L3_task_tcp_handle(&ts_tcp);
 
 		//tcp master->slaver发送逻辑控制
-		L3_task_tcp_control_handle(&ts_tcp_control);
+		//L3_task_tcp_control_handle(&ts_tcp_control);
 	}	
 }
 //end main
diff --git a/source/app/task_pen_head.c b/source/app/task_pen_head.c
index 1f0aa4e..b4a287c 100644
--- a/source/app/task_pen_head.c
+++ b/source/app/task_pen_head.c
@@ -1,35 +1,95 @@
 #include "task_pen_head.h"
+#include "../msp/uart0.h"
+struct  _s_task_pen_head_ s_task_pen_write;
+struct  _s_task_pen_head_ s_task_pen_read;
 
-struct  _s_task_pen_head_ s_task_pen_head;
 
 
-void L3_task_pen_head_init()
+void L3_task_pen_head_write_init(void)
 {
-	L1_task_init(&s_task_pen_head.task);
-	L3_task_s_go(s_task_pen_head,D_task_init);	
+	L1_task_init(&s_task_pen_write.task);
+	L3_task_s_go(s_task_pen_write,D_task_init);
+	s_task_pen_write.full = 0;
 }
-#define TTSS_TASK_HEAD_DATA_WRITE						0x01
+void L3_task_pen_head_read_init(void)
+{
+	L1_task_init(&s_task_pen_read.task);
+	L3_task_s_go(s_task_pen_read,D_task_init);
+}
+
+#define TTSS_TASK_HEAD_DATA_WRITE		0x01
+#define TTSS_TASK_HEAD_DATA		0x02
 
 U8 i = 0;
-void L3_task_pen_head_handle(struct _s_task_pen_head_ *s)
+U8 j ;
+void L3_task_pen_head_write_handle(struct _s_task_pen_head_ *s)
 {
 	TTSS_Task_init()
 		L2_task_go_Tdelay(TTSS_TASK_HEAD_DATA_WRITE,0);
 	TTSS_Task_step(TTSS_TASK_HEAD_DATA_WRITE)
+		s->point.x_axis = i;
+		s->point.y_axis = i;
+		s->point.time = D_sys_now;
+		i++;
+		L0_uart2_ushex(s->point.x_axis);
+		if(Lc_write_cyc_buf(&s->point,&wr_buf,1) == 0)
 		{
-			s->point.x_axis = i;
-			s->point.y_axis = i;
-			s->point.time = D_sys_now;
-			i++;
-			Lc_write_cyc_buf(&s->point,&wr_buf,1);
-			Lc_buf_full(&wr_buf);
+			s->full = 1;
 		}
-		L2_task_go_Tdelay(TTSS_TASK_HEAD_DATA_WRITE,D_Tdelay_20ms);
+		
+		#if 0
+			for(j = 0;j<POINT_LEN*2;j++)
+			{
+				L0_uart0_ushex(wr_buf.buf[j].x_axis);
+				L0_uart0_uc(' ');
+				L0_uart0_ushex(wr_buf.buf[j].y_axis);
+				L0_uart0_uc(' ');
+				L0_uart0_ulhex(wr_buf.buf[j].time);
+				L0_uart0_0d0a();
+			}
+			L2_task_go_Tdelay(TTSS_TASK_HEAD_DATA,D_Tdelay_100ms);
+		
+			U16 k = Lc_read_cyc_buf(R.points,&wr_buf, POINT_LEN);
+			for(j = 0;j<k;j++)
+			{
+				L0_uart0_ushex(R.points[j].x_axis);
+				L0_uart0_uc(' ');
+				L0_uart0_ushex(R.points[j].y_axis);
+				L0_uart0_uc(' ');
+				L0_uart0_ulhex(R.points[j].time);
+				L0_uart0_0d0a();
+			}//Lc_buf_full(&wr_buf);
+		}
+		#endif
+		L2_task_go_Tdelay(TTSS_TASK_HEAD_DATA_WRITE,D_Tdelay_100ms);
 	TTSS_Task_end();
 }
 
+#define TTSS_TASK_HEAD_DATA_READ 0x21
 
-
-
+void L3_task_pen_head_read_handle(struct _s_task_pen_head_ *s)
+{	
+	TTSS_Task_init()
+		L2_task_go_Tdelay(TTSS_TASK_HEAD_DATA_READ,0);	
+	TTSS_Task_step(TTSS_TASK_HEAD_DATA_READ)
+		if(s_task_pen_write.full)
+		{	
+			s_task_pen_write.full = 0;
+			Lc_read_cyc_buf(R.points,&wr_buf, 10);
+			//G.ccmd_slaver_info[2].extra_num = sizeof(R.points)/2; 
+			for(j = 0;j<10;j++)
+			{
+				L0_uart0_ushex(R.points[j].x_axis);
+				L0_uart0_uc(' ');
+				L0_uart0_ushex(R.points[j].y_axis);
+				L0_uart0_uc(' ');
+				L0_uart0_ulhex(R.points[j].time);
+				L0_uart0_0d0a();
+			}
+		}
+		
+		L2_task_go_Tdelay(TTSS_TASK_HEAD_DATA_READ,D_Tdelay_50ms);
+	TTSS_Task_end();
+}
 
 
diff --git a/source/app/task_pen_head.h b/source/app/task_pen_head.h
index 69646b8..dbb391b 100644
--- a/source/app/task_pen_head.h
+++ b/source/app/task_pen_head.h
@@ -7,16 +7,22 @@
 #include "../tpc/at0d0a.h"
 #include "../tpc/ccmodbus.h"
 #include "../app/app_config.h"
+
+
 struct _s_task_pen_head_
 {
 	TS_task task;
 	vU32 last_write_time;
 	vU32 now_write_time;
 	vU32 time_lag;
+	vU8 full;
+	vU8 null;
 	PenPoint point;
 };
-extern struct  _s_task_pen_head_ s_task_pen_head;
-extern void L3_task_pen_head_init();
-extern void L3_task_pen_head_handle(struct _s_task_pen_head_ *s);
-
-#endif
\ No newline at end of file
+extern struct  _s_task_pen_head_ s_task_pen_write;
+extern struct  _s_task_pen_head_ s_task_pen_read;
+extern void L3_task_pen_head_write_init();
+extern void L3_task_pen_head_read_init();
+extern void L3_task_pen_head_write_handle(struct _s_task_pen_head_ *s);
+extern void L3_task_pen_head_read_handle(struct _s_task_pen_head_ *s);
+#endif
diff --git a/source/clib/clib.c b/source/clib/clib.c
index 951b58e..1dfd65b 100644
--- a/source/clib/clib.c
+++ b/source/clib/clib.c
@@ -88,7 +88,7 @@ void Lc_delay_ms(vU16 i)
 	}
 }
 
-void Lc_buf_copy_uc(U8 *dst,U8 *src,U8 len)
+void Lc_buf_copy_uc(U8 *dst,U8 *src,U16 len)
 {
 	while(len--)
 	{
diff --git a/source/clib/clib.h b/source/clib/clib.h
index 127388b..41bc041 100644
--- a/source/clib/clib.h
+++ b/source/clib/clib.h
@@ -112,7 +112,7 @@ extern int Lc_strlen(char *str);
 extern U32 Lc_vU32_avg(U32 *d, U8 n);
 extern U32 Lc_vS32_media(U32 *d, U8 n);
 extern int Lc_memset(U8 *buf,U8 c,U16 len);
-extern void Lc_buf_copy_uc(U8 *dst,U8 *src,U8 len);
+extern void Lc_buf_copy_uc(U8 *dst,U8 *src,U16 len);
 extern U8 Lc_strStartsWith(U8 *s1,U8 *s2);
 
 
diff --git a/source/ctask/tick.h b/source/ctask/tick.h
index fd85754..42f156a 100644
--- a/source/ctask/tick.h
+++ b/source/ctask/tick.h
@@ -46,6 +46,7 @@ extern struct  _s_nos_tick_ s_nos_tick;
 #define D_Tdelay_5ms		((5-1)   / JIFFIES + 1)
 #define D_Tdelay_10ms		((10-1)  / JIFFIES + 1)
 #define D_Tdelay_20ms		((20-1)  / JIFFIES + 1)
+#define D_Tdelay_50ms		((50-1)  / JIFFIES + 1)
 
 #define D_Tdelay_100ms		((100-1) / JIFFIES + 1)
 #define D_Tdelay_200ms		((200-1) / JIFFIES+ 1)
diff --git a/source/tpc/ccmodbus.c b/source/tpc/ccmodbus.c
index 6a92d36..f8ff9be 100644
--- a/source/tpc/ccmodbus.c
+++ b/source/tpc/ccmodbus.c
@@ -69,7 +69,7 @@ U8 L3_pack_ccmodbus_10(TS_PH3_ccmodbus *pmodbus ,U8 slaverId, U16 reg, U16 num,
 {
 	U8 bufsize = 5,i = 0;
 	num += extra_num;
-	bytes = num*2; 
+	bytes = num * 2; 
 	pmodbus->slaver = slaverId;
 	pmodbus->oper = MODBUS_OPER_WRITE_M;
 	pmodbus->buf[0] = reg >> 8 & 0xFF;
@@ -177,7 +177,6 @@ void L1_s2b_PH3(TS_Handle_PH3 *p)// reentrant
 	{
 		if ((p->cashe[1] == p->head_0)&&(p->cashe[0] == p->head_1))
 		{
-			LED1 ^= 1;
 			p->head = 1;
 			p->max = D_s_PH3_ccmodbus_max - 1;
 			p->sp = (unsigned char *)&(p->ts_ccmodbus);