From b2500a8eb6665ce6efe0a7d954b6f101af83d7ec Mon Sep 17 00:00:00 2001
From: 554325746@qq.com <554325746@qq.com>
Date: 星期三, 25 三月 2020 11:31:41 +0800
Subject: [PATCH] debug
---
run.go | 288 +++++++++++++++++++++++++++++++++++++++------------------
1 files changed, 196 insertions(+), 92 deletions(-)
diff --git a/run.go b/run.go
index bec3732..0281af5 100644
--- a/run.go
+++ b/run.go
@@ -1,131 +1,235 @@
package main
+/*
+#include <stdlib.h>
+#include <string.h>
+void* crop_image(void *vsrc, int srcW, int srcH, int x0, int y0, int x1, int y1, int channel, int *length)
+{
+ if (x0 < 0) x0 = 0;
+ if (x0 > srcW) x0 = srcW-1;
+ if (x1 < 0) x1 = 0;
+ if (x1 > srcW) x1 = srcW-1;
+
+ if (y0 < 0) y0 = 0;
+ if (y0 > srcH) y0 = srcH-1;
+ if (y1 < 0) y1 = 0;
+ if (y1 > srcH) y1 = srcH-1;
+
+ if (x1 - x0 <= 0 || y1 - y0 <= 0) return NULL;
+
+ if (x1-x0 > srcW) x1 = srcW-x0;
+ if (y1-y0 > srcH) y1 = srcH-y0;
+
+
+ unsigned char *src = (unsigned char*)vsrc;
+
+ int destW = x1 - x0 + 1;
+ int destH = y1 - y0 + 1;
+
+ *length = channel * destW * destH;
+ unsigned char * desData = (unsigned char*)malloc(*length);
+
+ int i = 0;
+ int destIdy = 0;
+
+ for (i = y0; i <= y1; i++)
+ {
+ destIdy = i - y0;
+ memcpy(&(desData[destIdy * destW * channel]), &(src[(i * srcW + x0) * channel]),sizeof(char) * channel * destW);
+ }
+
+ return desData;
+}*/
+import "C"
import (
- "context"
- "unsafe"
+ "context"
+ "time"
+ "unsafe"
- "basic.com/libgowrapper/sdkhelper.git"
- "basic.com/valib/gogpu.git"
+ "reid/rpc"
- "basic.com/pubsub/protomsg.git"
+ "reid/common"
- "basic.com/valib/deliver.git"
- "github.com/gogo/protobuf/proto"
+ "basic.com/valib/gogpu.git"
+
+ "basic.com/pubsub/protomsg.git"
+
+ "github.com/gogo/protobuf/proto"
)
type reid struct {
- handle *ReID
- list *sdkhelper.LockList
- fnLogger func(...interface{})
+ handle *ReID
+ fnLogger func(...interface{})
- ipc string
+ gpu int
+ ipc string
}
// Create Reid
-func Create(config string, typ, id string, gpu int, shm bool, ipc2Rule string, ruleMaxSize int, fn func(...interface{}), reserved map[string]interface{}) interface{} {
+func Create(config string, typ, id string, gpu int, shm bool, fn func(...interface{}), reserved map[string]interface{}) interface{} {
- cfg, err := sdkhelper.ReadConfig(config)
- if err != nil {
- fn("Reid SDK Create Error When Read Config: ", err)
- return nil
- }
+ cfg, err := common.ReadConfig(config)
+ if err != nil {
+ fn("Reid SDK Create Error When Read Config: ", err)
+ return nil
+ }
- sModel, sGPU, sIPC :=
- "reid-model",
- "gpu-memory",
- "ipc-url"
+ sModel, sGPU, sIPC :=
+ "reid-model",
+ "gpu-memory",
+ "ipc-url"
- params := []string{sModel, sGPU, sIPC}
+ params := []string{sModel, sGPU, sIPC}
- for _, v := range params {
- if _, ok := cfg.Param[v]; !ok {
- fn("Reid SDK Create Error Because of Param Not Found: ", v)
- return nil
- }
- }
+ for _, v := range params {
+ if _, ok := cfg.Param[v]; !ok {
+ fn("Reid SDK Create Error Because of Param Not Found: ", v)
+ return nil
+ }
+ }
- gpuM := sdkhelper.Atoi(cfg.Param[sGPU])
+ gpuM := common.Atoi(cfg.Param[sGPU])
- rGPU := 0
+ rGPU := gpu
- if rGPU == -1 {
- rGPU = gogpu.ValidGPU(gpuM + 512)
- }
- if rGPU == -1 {
- fn("Reid SDK Create Error When Find GPU")
- return nil
- }
+ if rGPU == -1 {
+ rGPU = gogpu.ValidGPU(gpuM + 512)
+ }
- rGPU = 0
+ handle := NewSDK(rGPU, cfg.Param[sModel])
+ if handle == nil {
+ fn("Reid SDK Create Error When New SDK")
+ return nil
+ }
- handle := NewSDK(rGPU, cfg.Param[sModel])
- if handle == nil {
- fn("Reid SDK Create Error When New SDK")
- return nil
- }
+ return &reid{
+ handle: handle,
+ fnLogger: fn,
- return &reid{
- handle: handle,
- list: sdkhelper.NewLockList(6),
- fnLogger: fn,
-
- ipc: cfg.Param[sIPC],
- }
+ gpu: rGPU,
+ ipc: cfg.Param[sIPC],
+ }
}
// Run run
func Run(ctx context.Context, i interface{}) {
- s := i.(*reid)
+ s := i.(*reid)
- c := deliver.NewClient(deliver.ReqRep, s.ipc)
+ const (
+ postPull = `_2`
+ postPush = `_1`
+ )
- var msg []byte
- var err error
+ ipcSnd := s.ipc + postPush
+ ipcRcv := s.ipc + postPull
- for {
- select {
- case <-ctx.Done():
- return
- default:
+ sndURL := common.GetIpcAddress(true, ipcSnd)
+ rcvURL := common.GetIpcAddress(true, ipcRcv)
- msg, err = c.Recv()
- if err != nil {
- continue
- }
+ chSnd := make(chan []byte, 3)
+ chRcv := make(chan []byte, 3)
- i := &protomsg.Image{}
- err := proto.Unmarshal(msg, i)
- if err != nil {
- s.fnLogger("REID~~~~~~protobuf decode CameraImage error: ", err)
- continue
- }
- if i.Data == nil {
- s.fnLogger("REID~~~~~~protomsg.Image data null")
- continue
- }
- s.fnLogger("REID~~~~~~Recv Image:", len(i.Data))
+ recv := rpc.NewReciever(rcvURL, chRcv, true, s.fnLogger)
+ go recv.Run(ctx)
- feat := s.handle.Extract2(unsafe.Pointer(&i.Data[0]), int(i.Width), int(i.Height), 3)
- if feat == nil {
+ chMsg := make(chan protomsg.SdkMessage, 3)
+ go common.UnserilizeProto(ctx, chRcv, chMsg, s.fnLogger)
- }
- buf := float32SliceAsByteSlice(feat)
- c.Send(buf)
- }
+ send := rpc.NewSender(sndURL, chSnd, true, s.fnLogger)
+ go send.Run(ctx)
- }
+ for {
+ select {
+ case <-ctx.Done():
+ return
+ case msg := <-chMsg:
+ // if data, err := proto.Marshal(&msg); err == nil {
+ // if data == nil {
+ // s.fnLogger("reid !!!!!! proto.Marshal Failed To Marshal proto.SdkMessage")
+ // continue
+ // }
+ // s.fnLogger("reid~~~~~~MSG Send Back To Humantrack Length:", len(data))
+
+ // chSnd <- data
+ // } else {
+ // s.fnLogger("reid !!!!!! proto.Marshal Out Msg Error:", err)
+ // }
+ // continue
+ //////////////////////////////////////////////////////use reid
+ if len(msg.Tasklab.Sdkinfos) == 0 || int(msg.Tasklab.Index) >= len(msg.Tasklab.Sdkinfos) {
+ s.fnLogger("reid !!!!!! Recv Msg From Humantrack Error")
+ sendback(&msg, chSnd, s.fnLogger)
+ continue
+ }
+
+ i := common.UnpackImage(msg, "reid", s.fnLogger)
+ if i == nil || i.Data == nil || i.Width <= 0 || i.Height <= 0 {
+ s.fnLogger("reid !!!!!! Unpack Image From Humantrack Msg Failed")
+ sendback(&msg, chSnd, s.fnLogger)
+ continue
+ }
+
+ sdkInfo := msg.Tasklab.Sdkinfos[int(msg.Tasklab.Index)]
+ if sdkInfo.Sdkdata == nil || len(sdkInfo.Sdkdata) < 2 {
+ sendback(&msg, chSnd, s.fnLogger)
+ continue
+ }
+ s.fnLogger("reid~~~~~~Recv From Humantrack Image Len:", len(i.Data), "SDK Result Length: ", len(sdkInfo.Sdkdata))
+
+ res := &protomsg.HumanTrackResult{}
+ if err := proto.Unmarshal(sdkInfo.Sdkdata, res); err != nil {
+ s.fnLogger("reid !!!!!! proto.Unmarshal SDK Result From Humantrack msg Error:", err)
+ sendback(&msg, chSnd, s.fnLogger)
+ continue
+ }
+
+ for _, v := range res.Result {
+
+ var clen C.int
+ l, t, r, b := C.int(v.RcHuman.Left), C.int(v.RcHuman.Top), C.int(v.RcHuman.Right), C.int(v.RcHuman.Bottom)
+ w, h := int(r-l+1), int(b-t+1)
+ cutImg := C.crop_image(unsafe.Pointer(&i.Data[0]), C.int(i.Width), C.int(i.Height), l, t, r, b, 3, &clen)
+ if cutImg != nil && int(clen) == w*h*3 {
+ data := C.GoBytes(unsafe.Pointer(cutImg), clen)
+ // dl := int(clen)
+ // data := (*[1 << 26]byte)((*[1 << 26]byte)(cutImg))[:dl:dl]
+
+ // w, h := int(r-l+1), int(b-t+1)
+ v.Feature = s.handle.Extract2(unsafe.Pointer(&data[0]), w, h, 3)
+ C.free(cutImg)
+ } else{
+ s.fnLogger("reid!!!!!!Cut Image Error Len:", clen, "size:", w, "x", h)
+ }
+
+ }
+
+ if res.Result != nil && len(res.Result) > 0 {
+ if out, err := proto.Marshal(res); err == nil {
+ msg.Tasklab.Sdkinfos[int(msg.Tasklab.Index)].Sdkdata = out
+ s.fnLogger("reid~~~~~~Send To Humantrack Result Length:", len(out))
+ }
+ }
+
+ sendback(&msg, chSnd, s.fnLogger)
+ default:
+
+ time.Sleep(10 * time.Millisecond)
+
+ }
+
+ }
}
-func float32SliceAsByteSlice(src []float32) []byte {
- if len(src) == 0 {
- return nil
- }
+func sendback(msg *protomsg.SdkMessage, ch chan<- []byte, fn func(...interface{})) {
+ if data, err := proto.Marshal(msg); err == nil {
+ if data == nil {
+ fn("reid !!!!!! proto.Marshal Failed To Marshal proto.SdkMessage")
+ return
+ }
+ fn("reid~~~~~~MSG Send Back To Humantrack Length:", len(data))
- l := len(src) * 4
- ptr := unsafe.Pointer(&src[0])
- // It is important to keep in mind that the Go garbage collector
- // will not interact with this data, and that if src if freed,
- // the behavior of any Go code using the slice is nondeterministic.
- // Reference: https://github.com/golang/go/wiki/cgo#turning-c-arrays-into-go-slices
- return (*[1 << 26]byte)((*[1 << 26]byte)(ptr))[:l:l]
+ ch <- data
+ } else {
+ fn("reid !!!!!! proto.Marshal Out Msg Error:", err)
+ }
}
--
Gitblit v1.8.0