From db20b766e2020950ed64a89065c8599a2ad69ff2 Mon Sep 17 00:00:00 2001
From: zhangmeng <775834166@qq.com>
Date: 星期二, 14 一月 2020 18:01:12 +0800
Subject: [PATCH] update

---
 run.go           |   42 +-
 go.sum           |    2 
 common/recv.go   |  116 ++++++++++
 common/torule.go |  128 +++++++++++
 common/helper.go |  174 +++++++++++++++
 go.mod           |    3 
 common/send.go   |  141 ++++++++++++
 7 files changed, 581 insertions(+), 25 deletions(-)

diff --git a/common/helper.go b/common/helper.go
new file mode 100644
index 0000000..0e016c3
--- /dev/null
+++ b/common/helper.go
@@ -0,0 +1,174 @@
+package common
+
+import (
+	"context"
+	"encoding/json"
+	"fmt"
+	"io/ioutil"
+	"strconv"
+	"time"
+
+	"basic.com/libgowrapper/sdkstruct.git"
+	"basic.com/pubsub/protomsg.git"
+	"basic.com/valib/deliver.git"
+	"github.com/gogo/protobuf/proto"
+)
+
+const mode = deliver.PushPull
+
+// GetIpcAddress get ipc
+func GetIpcAddress(shm bool, id string) string {
+	if shm {
+		return id
+	}
+	return `ipc:///tmp/` + id + `.ipc`
+}
+
+// SubConfig sub
+type SubConfig struct {
+	SoFile string            `json:"so_file_path"`
+	Env    string            `json:"runtime"`
+	Param  map[string]string `json:"param"`
+}
+
+// SdkConfig sdk
+type SdkConfig struct {
+	SoFile string            `json:"so_file_path"`
+	Env    string            `json:"runtime"`
+	Param  map[string]string `json:"param"`
+	Sub    *SubConfig        `json:"sub"`
+}
+
+// ReadConfig conf
+func ReadConfig(file string) (SdkConfig, error) {
+	data, err := ioutil.ReadFile(file)
+	if err != nil {
+		return SdkConfig{}, fmt.Errorf("READ SDK CONFIG FILE %s ERROR", file)
+	}
+
+	//璇诲彇鐨勬暟鎹负json鏍煎紡锛岄渶瑕佽繘琛岃В鐮�
+	var v SdkConfig
+	err = json.Unmarshal(data, &v)
+
+	return v, err
+}
+
+// Atoi atoi
+func Atoi(s string) int {
+	i, _ := strconv.Atoi(s)
+	return i
+}
+
+// UnserilizeProto un
+func UnserilizeProto(ctx context.Context, data <-chan []byte, out chan<- protomsg.SdkMessage, fn func(...interface{})) {
+	for {
+		select {
+		case <-ctx.Done():
+			return
+		case d := <-data:
+			if len(d) < 100 {
+				continue
+			}
+			msg := protomsg.SdkMessage{}
+			if err := proto.Unmarshal(d, &msg); err != nil {
+				fn(err, " msg 澶勭悊寮傚父")
+				continue
+			}
+
+			out <- msg
+
+		default:
+			time.Sleep(10 * time.Millisecond)
+		}
+	}
+}
+
+// Msg2MsgSDK msg->msgsdk
+func Msg2MsgSDK(msg protomsg.SdkMessage) *sdkstruct.MsgSDK {
+
+	d, err := proto.Marshal(&msg)
+	if err != nil {
+		return nil
+	}
+
+	index, count := int(msg.Tasklab.Index), len(msg.Tasklab.Sdkinfos)
+	if index >= count {
+		return &sdkstruct.MsgSDK{
+			MsgData:    d,
+			SdkCount:   count,
+			SdkIndex:   index,
+			SdkDataLen: 0,
+		}
+	}
+
+	return &sdkstruct.MsgSDK{
+		MsgData:    d,
+		SdkCount:   count,
+		SdkIndex:   index,
+		SdkDataLen: len(d),
+	}
+}
+
+// EjectResult eject
+func EjectResult(res []byte, msg protomsg.SdkMessage, out chan<- sdkstruct.MsgSDK) {
+
+	if res == nil {
+		s := Msg2MsgSDK(msg)
+		if s == nil {
+			return
+		}
+		out <- *s
+		return
+	}
+
+	msg.Tasklab.Sdkinfos[int(msg.Tasklab.Index)].Sdkdata = res
+
+	s := Msg2MsgSDK(msg)
+	if s == nil {
+		return
+	}
+	out <- *s
+}
+
+/////////////////////////////////////////////////////////////
+
+// ValidRemoteMessage valid or not
+func ValidRemoteMessage(msg protomsg.SdkMessage, fnName string, fn func(...interface{})) bool {
+	if msg.Tasklab == nil {
+		fn(fnName, " recieve msg nil")
+		return false
+	}
+
+	sdkLen := len(msg.Tasklab.Sdkinfos)
+	if sdkLen == 0 {
+		fn(fnName, " has no sdk info")
+		return false
+	}
+
+	curIndex := int(msg.Tasklab.Index)
+	if curIndex < 0 || curIndex >= sdkLen {
+		fn(fnName, " tasklab index ", curIndex, " error")
+		return false
+	}
+	if msg.Tasklab.Sdkinfos[curIndex].Sdktype != fnName {
+		fn(fnName, " is different from ", msg.Tasklab.Sdkinfos[curIndex].Sdktype)
+		return false
+	}
+	return true
+}
+
+// UnpackImage unpack
+func UnpackImage(msg protomsg.SdkMessage, fnName string, fn func(...interface{})) *protomsg.Image {
+	// 鍙嶅簭鍒楀寲鏁版嵁寰楀埌sdk鍏ュ弬
+	i := &protomsg.Image{}
+	err := proto.Unmarshal(msg.Data, i)
+	if err != nil {
+		fn(fnName, " protobuf decode CameraImage error: ", err.Error())
+		return nil
+	}
+	if i.Data == nil {
+		fn(fnName, " protomsg.Image data null")
+		return nil
+	}
+	return i
+}
diff --git a/common/recv.go b/common/recv.go
new file mode 100644
index 0000000..fb31433
--- /dev/null
+++ b/common/recv.go
@@ -0,0 +1,116 @@
+package common
+
+import (
+	"context"
+
+	"time"
+
+	"basic.com/valib/deliver.git"
+)
+
+// Reciever recv from ipc
+type Reciever struct {
+	ctx    context.Context
+	ipcURL string
+	out    chan<- []byte
+
+	shm      bool
+	fnLogger func(...interface{})
+}
+
+// NewReciever new recv
+func NewReciever(url string, out chan<- []byte, shm bool, fn func(...interface{})) *Reciever {
+	return &Reciever{
+		ipcURL:   url,
+		out:      out,
+		shm:      shm,
+		fnLogger: fn,
+	}
+}
+
+// Run run a IPC client
+func (r *Reciever) Run(ctx context.Context) {
+
+	if r.shm {
+		r.runShm(ctx)
+	} else {
+		r.run(ctx, deliver.NewClient(mode, r.ipcURL))
+	}
+}
+
+func (r *Reciever) run(ctx context.Context, i deliver.Deliver) {
+
+	// t := time.Now()
+	// sc := 0
+
+	count := 0
+
+	for {
+		select {
+		case <-ctx.Done():
+			i.Close()
+			return
+		default:
+
+			if r.shm {
+				if d, err := i.Recv(); err != nil {
+					i.Close()
+					r.fnLogger("ANALYSIS RECV ERROR: ", err)
+
+					c, err := deliver.NewClientWithError(deliver.Shm, r.ipcURL)
+					for {
+						if err == nil {
+							break
+						}
+						time.Sleep(time.Second)
+						c, err = deliver.NewClientWithError(deliver.Shm, r.ipcURL)
+						r.fnLogger("ANALYSIS CREATE FAILED : ", err)
+					}
+					i = c
+					r.fnLogger("ANALYSIS CREATE SHM")
+				} else {
+					if d != nil {
+						count++
+						if count > 10 {
+							count = 0
+							r.fnLogger("~~~shm recv image:", len(d))
+						}
+						r.out <- d
+					}
+				}
+			} else {
+				if msg, err := i.Recv(); err != nil {
+					// logo.Errorln("recv error : ", err, " url: ", r.ipcURL)
+				} else {
+					count++
+					if count > 10 {
+						count = 0
+						r.fnLogger("~~~mangos recv image:", len(msg))
+					}
+					r.out <- msg
+				}
+			}
+
+			// sc++
+			// if sc == 25 {
+			// 	logo.Infoln("SDK RECV 25 FRAME USE TIME: ", time.Since(t))
+			// 	sc = 0
+			// 	t = time.Now()
+			// }
+
+		}
+	}
+}
+
+func (r *Reciever) runShm(ctx context.Context) {
+	c, err := deliver.NewClientWithError(deliver.Shm, r.ipcURL)
+	for {
+		if err == nil {
+			break
+		}
+		time.Sleep(1 * time.Second)
+		c, err = deliver.NewClientWithError(deliver.Shm, r.ipcURL)
+		r.fnLogger("CLIENT CREATE FAILED : ", err)
+	}
+	r.run(ctx, c)
+}
diff --git a/common/send.go b/common/send.go
new file mode 100644
index 0000000..a0e7cc4
--- /dev/null
+++ b/common/send.go
@@ -0,0 +1,141 @@
+package common
+
+import (
+	"context"
+	"time"
+
+	"basic.com/libgowrapper/sdkstruct.git"
+	"basic.com/valib/deliver.git"
+)
+
+// Sender decoder ingo
+type Sender struct {
+	ipcURL string
+	chMsg  <-chan sdkstruct.MsgSDK
+	shm    bool
+	fn     func([]byte, bool)
+
+	fnLogger func(...interface{})
+}
+
+// ApplyCallbackFunc cb
+func (s *Sender) ApplyCallbackFunc(f func([]byte, bool)) {
+
+	if s.fn == nil {
+		s.fn = f
+	}
+}
+
+// NewSender Sender
+func NewSender(ipcURL string, chMsg <-chan sdkstruct.MsgSDK, shm bool, fn func(...interface{})) *Sender {
+	// logo.Infof("create ipc %s for decode : %s\n", ipcURL, ipcURL)
+	return &Sender{
+		ipcURL:   ipcURL,
+		chMsg:    chMsg,
+		shm:      shm,
+		fn:       nil,
+		fnLogger: fn,
+	}
+}
+
+// Run run a IPC producer
+func (s *Sender) Run(ctx context.Context) {
+
+	if s.shm {
+		s.runShm(ctx)
+	} else {
+		i := deliver.NewClient(mode, s.ipcURL)
+		if i == nil {
+			s.fnLogger("sender 2 pubsub nng create error")
+			return
+		}
+		s.run(ctx, i)
+	}
+}
+
+func (s *Sender) serializeProto(ctx context.Context, data chan<- []byte) {
+
+	for {
+		select {
+		case <-ctx.Done():
+			s.fnLogger("stop Sender")
+			return
+		case i := <-s.chMsg:
+
+			data <- i.MsgData
+
+			if int(i.SdkIndex+1) == i.SdkCount {
+				if s.fn != nil {
+
+					sFlag := true
+					if i.SdkDataLen < 2 {
+						sFlag = false
+					}
+					s.fn(i.MsgData, sFlag)
+
+				}
+			}
+		default:
+			time.Sleep(10 * time.Millisecond)
+		}
+	}
+}
+
+func (s *Sender) run(ctx context.Context, i deliver.Deliver) {
+
+	// go ruleserver.TimeTicker()
+
+	dataChan := make(chan []byte, 3)
+	go s.serializeProto(ctx, dataChan)
+
+	for {
+		select {
+		case <-ctx.Done():
+			i.Close()
+			return
+		case d := <-dataChan:
+
+			if s.shm {
+				if err := i.Send(d); err != nil {
+					i.Close()
+					s.fnLogger("ANALYSIS SENDER ERROR: ", err)
+
+					c, err := deliver.NewClientWithError(deliver.Shm, s.ipcURL)
+					for {
+						if err == nil {
+							break
+						}
+						time.Sleep(time.Second)
+						c, err = deliver.NewClientWithError(deliver.Shm, s.ipcURL)
+						s.fnLogger("CLIENT CREATE FAILED : ", err)
+					}
+					i = c
+				} else {
+
+				}
+			} else {
+				err := i.Send(d)
+				if err != nil {
+					// logo.Errorln("error sender 2 pubsub: ", err)
+				} else {
+					s.fnLogger("mangos send to pubsub len: ", len(d))
+				}
+			}
+		default:
+			time.Sleep(10 * time.Millisecond)
+		}
+	}
+}
+
+func (s *Sender) runShm(ctx context.Context) {
+	c, err := deliver.NewClientWithError(deliver.Shm, s.ipcURL)
+	for {
+		if err == nil {
+			break
+		}
+		time.Sleep(1 * time.Second)
+		c, err = deliver.NewClientWithError(deliver.Shm, s.ipcURL)
+		s.fnLogger("CLIENT CREATE FAILED : ", err)
+	}
+	s.run(ctx, c)
+}
diff --git a/common/torule.go b/common/torule.go
new file mode 100644
index 0000000..c8be086
--- /dev/null
+++ b/common/torule.go
@@ -0,0 +1,128 @@
+package common
+
+import (
+	"container/list"
+	"context"
+	"sync"
+	"time"
+
+	"basic.com/valib/deliver.git"
+	// "basic.com/pubsub/protomsg.git"
+	// "github.com/gogo/protobuf/proto"
+)
+
+type runResult struct {
+	data  []byte
+	valid bool
+}
+
+// ToRule ipc
+type ToRule struct {
+	ipcURL   string
+	maxSize  int
+	cache    *list.List
+	cv       *sync.Cond
+	cond     bool
+	fnLogger func(...interface{})
+}
+
+// NewToRule send to ruleprocess
+func NewToRule(ipcURL string, maxSize int, fn func(...interface{})) *ToRule {
+	return &ToRule{
+		ipcURL:   ipcURL,
+		maxSize:  maxSize,
+		cache:    list.New(),
+		cv:       sync.NewCond(&sync.Mutex{}),
+		cond:     false,
+		fnLogger: fn,
+	}
+}
+
+// Push data
+func (t *ToRule) Push(data []byte, valid bool) {
+
+	t.cv.L.Lock()
+	result := runResult{data, valid}
+	t.cache.PushBack(result)
+	if t.cache.Len() > t.maxSize {
+		for i := 0; i < t.cache.Len(); {
+			d := t.cache.Front().Value.(runResult)
+			if d.valid == false {
+				t.cache.Remove(t.cache.Front())
+				i = i + 2
+			} else {
+				i = i + 1
+			}
+		}
+	}
+	if t.cache.Len() > t.maxSize {
+		for i := 0; i < t.cache.Len(); {
+			t.cache.Remove(t.cache.Front())
+			i = i + 2
+		}
+	}
+	// logo.Infof("push to cache count : %d\n", t.cache.Len())
+	t.cond = true
+	t.cv.Signal()
+	t.cv.L.Unlock()
+}
+
+// Run forever
+func (t *ToRule) Run(ctx context.Context) {
+
+	var i deliver.Deliver
+	var err error
+
+	for {
+		i, err = deliver.NewClientWithError(deliver.PushPull, t.ipcURL)
+		if err != nil {
+			time.Sleep(time.Second)
+			t.fnLogger("wait create to rule ipc", err)
+			continue
+		}
+		break
+	}
+
+	count := 0
+
+	for {
+		select {
+		case <-ctx.Done():
+			return
+		default:
+
+			var d []byte
+			t.cv.L.Lock()
+
+			for !t.cond {
+				t.cv.Wait()
+			}
+
+			for j := 0; j < 8; j++ {
+				if t.cache.Len() <= 0 {
+					break
+				}
+
+				d = t.cache.Front().Value.(runResult).data
+				if i != nil && d != nil {
+
+					err := i.Send(d)
+					if err != nil {
+						t.fnLogger("!!!!!!!!!!!!!!!!!!!!!!!!!!!", err)
+					} else {
+						count++
+						if count > 5 {
+							count = 0
+							t.fnLogger("~~~~~~SEND TO RULE CORRECT")
+						}
+					}
+				}
+				t.cache.Remove(t.cache.Front())
+			}
+
+			t.cond = false
+			t.cv.L.Unlock()
+
+		}
+	}
+}
diff --git a/go.mod b/go.mod
index 94144bf..7c54cd5 100644
--- a/go.mod
+++ b/go.mod
@@ -3,10 +3,9 @@
 go 1.12
 
 require (
-	basic.com/libgowrapper/sdkhelper.git v0.0.0-20200114085924-c24f06e4cc8b
 	basic.com/libgowrapper/sdkstruct.git v0.0.0-20191220011601-e0b3d1f0183c
 	basic.com/pubsub/protomsg.git v0.0.0-20191219033725-b95da65535d0
-	basic.com/valib/deliver.git v0.0.0-20190927081905-2d390df9ede3 // indirect
+	basic.com/valib/deliver.git v0.0.0-20190927081905-2d390df9ede3
 	basic.com/valib/gogpu.git v0.0.0-20190711044327-62043b070865
 	basic.com/valib/shm.git v0.0.0-20191029034255-156e610f9bca // indirect
 	github.com/gogo/protobuf v1.3.1
diff --git a/go.sum b/go.sum
index 1704e67..6646224 100644
--- a/go.sum
+++ b/go.sum
@@ -1,5 +1,3 @@
-basic.com/libgowrapper/sdkhelper.git v0.0.0-20200114085924-c24f06e4cc8b h1:CWneZPtnrpSv1SDYtB/D+kna3njXNWLExUfQ4xM3Lxc=
-basic.com/libgowrapper/sdkhelper.git v0.0.0-20200114085924-c24f06e4cc8b/go.mod h1:eBHanxa92Srb5c/OmupgcAZmLC3Et5HMp9JsebHAIC4=
 basic.com/libgowrapper/sdkstruct.git v0.0.0-20191220011601-e0b3d1f0183c h1:maWYZw9iSQUuN1jbDxgi9IvKrCD97tiTCv8PkLArZ/I=
 basic.com/libgowrapper/sdkstruct.git v0.0.0-20191220011601-e0b3d1f0183c/go.mod h1:bNdkzVVGY+oQEcaYN9VlyIK/03WB3NQNQApjiPJjIag=
 basic.com/pubsub/protomsg.git v0.0.0-20191219033725-b95da65535d0 h1:5NOX81GTsRLwbhnHWYU4g6jfcOynSWetmf9PlhK5eLI=
diff --git a/run.go b/run.go
index 353c8ab..50cf58f 100644
--- a/run.go
+++ b/run.go
@@ -6,7 +6,7 @@
 	"sync"
 	"time"
 
-	"basic.com/libgowrapper/sdkhelper.git"
+	"face/common"
 
 	"basic.com/libgowrapper/sdkstruct.git"
 	"basic.com/pubsub/protomsg.git"
@@ -76,7 +76,7 @@
 		fn("Face SDK Create Error When New SDK")
 		return nil
 	}
-	cfg, err := sdkhelper.ReadConfig(config)
+	cfg, err := common.ReadConfig(config)
 	if err != nil {
 		fn("Face SDK Create Error When Read Config: ", err)
 		return nil
@@ -104,9 +104,9 @@
 	}
 
 	w, h, detThrd, detNum, detAngle, propThrd, extThrd, trckInterval, trckSmpl, maxChan, gpuM :=
-		1280, 720, sdkhelper.Atoi(cfg.Param[dt]), sdkhelper.Atoi(cfg.Param[dn]), sdkhelper.Atoi(cfg.Param[da]),
-		sdkhelper.Atoi(cfg.Param[pt]), sdkhelper.Atoi(cfg.Param[et]), sdkhelper.Atoi(cfg.Param[ti]), sdkhelper.Atoi(cfg.Param[ts]),
-		sdkhelper.Atoi(cfg.Param[mc]), sdkhelper.Atoi(cfg.Param[gm])
+		1280, 720, common.Atoi(cfg.Param[dt]), common.Atoi(cfg.Param[dn]), common.Atoi(cfg.Param[da]),
+		common.Atoi(cfg.Param[pt]), common.Atoi(cfg.Param[et]), common.Atoi(cfg.Param[ti]), common.Atoi(cfg.Param[ts]),
+		common.Atoi(cfg.Param[mc]), common.Atoi(cfg.Param[gm])
 
 	if detAngle > 0 {
 	}
@@ -171,14 +171,14 @@
 		postPull = `_1`
 		postPush = `_2`
 	)
-	ipcRcv := sdkhelper.GetIpcAddress(s.shm, s.id+postPull)
-	ipcSnd := sdkhelper.GetIpcAddress(s.shm, s.id+postPush)
+	ipcRcv := common.GetIpcAddress(s.shm, s.id+postPull)
+	ipcSnd := common.GetIpcAddress(s.shm, s.id+postPush)
 	chRcv := make(chan []byte, s.maxChannel)
 	chSnd := make(chan sdkstruct.MsgSDK, s.maxChannel)
 
-	rcver := sdkhelper.NewReciever(ipcRcv, chRcv, s.shm, s.fnLogger)
-	snder := sdkhelper.NewSender(ipcSnd, chSnd, s.shm, s.fnLogger)
-	torule := sdkhelper.NewToRule(s.ipc2Rule, s.ruleMsgMaxCacheSize, s.fnLogger)
+	rcver := common.NewReciever(ipcRcv, chRcv, s.shm, s.fnLogger)
+	snder := common.NewSender(ipcSnd, chSnd, s.shm, s.fnLogger)
+	torule := common.NewToRule(s.ipc2Rule, s.ruleMsgMaxCacheSize, s.fnLogger)
 
 	snder.ApplyCallbackFunc(torule.Push)
 
@@ -226,7 +226,7 @@
 func (f *face) run(ctx context.Context, in <-chan []byte, out chan<- sdkstruct.MsgSDK) {
 
 	chMsg := make(chan protomsg.SdkMessage, f.maxChannel)
-	go sdkhelper.UnserilizeProto(ctx, in, chMsg, f.fnLogger)
+	go common.UnserilizeProto(ctx, in, chMsg, f.fnLogger)
 
 	for {
 		select {
@@ -234,9 +234,9 @@
 			f.handle.Free()
 			return
 		case rMsg := <-chMsg:
-			if !sdkhelper.ValidRemoteMessage(rMsg, f.typ, f.fnLogger) {
+			if !common.ValidRemoteMessage(rMsg, f.typ, f.fnLogger) {
 				f.fnLogger("FACE TRACK VALIDREMOTEMESSAGE INVALID")
-				sdkhelper.EjectResult(nil, rMsg, out)
+				common.EjectResult(nil, rMsg, out)
 				continue
 			}
 
@@ -249,14 +249,14 @@
 				chn := f.getAvailableChn()
 				if chn < 0 {
 					f.fnLogger("TOO MUCH CHANNEL")
-					sdkhelper.EjectResult(nil, rMsg, out)
+					common.EjectResult(nil, rMsg, out)
 					continue
 				}
 				f.ftrackChannels[rMsg.Cid] = chn
 
-				i := sdkhelper.UnpackImage(rMsg, f.typ, f.fnLogger)
+				i := common.UnpackImage(rMsg, f.typ, f.fnLogger)
 				if i == nil {
-					sdkhelper.EjectResult(nil, rMsg, out)
+					common.EjectResult(nil, rMsg, out)
 					continue
 				}
 				// conv to bgr24 and resize
@@ -285,14 +285,14 @@
 
 		case rMsg := <-in:
 
-			if !sdkhelper.ValidRemoteMessage(rMsg, f.typ, f.fnLogger) {
-				sdkhelper.EjectResult(nil, rMsg, out)
+			if !common.ValidRemoteMessage(rMsg, f.typ, f.fnLogger) {
+				common.EjectResult(nil, rMsg, out)
 				continue
 			}
 
-			i := sdkhelper.UnpackImage(rMsg, f.typ, f.fnLogger)
+			i := common.UnpackImage(rMsg, f.typ, f.fnLogger)
 			if i == nil || i.Data == nil || i.Width <= 0 || i.Height <= 0 {
-				sdkhelper.EjectResult(nil, rMsg, out)
+				common.EjectResult(nil, rMsg, out)
 				continue
 			}
 
@@ -305,7 +305,7 @@
 
 			count, data, _ := f.handle.Run(i.Data, imgW, imgH, 3, dtchn)
 
-			sdkhelper.EjectResult(data, rMsg, out)
+			common.EjectResult(data, rMsg, out)
 			f.mtxRunning.Lock()
 			f.running = true
 			f.mtxRunning.Unlock()

--
Gitblit v1.8.0