debug

554325746@qq.com

2020-03-25 b2500a8eb6665ce6efe0a7d954b6f101af83d7ec

 run.go

@@ -1,151 +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 (
   "bufio"
   "context"
   "fmt"
   "io/ioutil"
   "os"
   "unsafe"
    "context"
    "time"
    "unsafe"

   "basic.com/libgowrapper/sdkhelper.git"
   "basic.com/valib/gogpu.git"
    "reid/rpc"

   "basic.com/pubsub/protomsg.git"
   "basic.com/valib/godraw.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
   fnLogger func(...interface{})
    handle   *ReID
    fnLogger func(...interface{})

   gpu int
   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 := gpu
    rGPU := gpu

   if rGPU == -1 {
      rGPU = gogpu.ValidGPU(gpuM + 512)
   }
    if rGPU == -1 {
        rGPU = gogpu.ValidGPU(gpuM + 512)
    }

   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,
        fnLogger: fn,

      gpu: rGPU,
      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)

         /////////////////////////////////
         if jpg, err := godraw.ToJpeg(i.Data, int(i.Width), int(i.Height), nil); err == nil {
            ioutil.WriteFile("./pic.jpg", jpg, 0644)
         }
         /////////////////////////////////
         feat := s.handle.Extract2(unsafe.Pointer(&i.Data[0]), int(i.Width), int(i.Height), 3)
         if feat == nil {
            // feat = make([]float32, 1)
         } else {
            for k := 0; k < 3; k++ {
               s.fnLogger("REID~~~~~~extractor---human_feats------%f", feat[k+2000])
            }
            s.fnLogger("REID~~~~~~Run Reid Use GPU: ", s.gpu)
    chMsg := make(chan protomsg.SdkMessage, 3)
    go common.UnserilizeProto(ctx, chRcv, chMsg, s.fnLogger)

            /////////////////////////////////
            if f, err := os.Create("./reid-feat.txt"); err == nil {
               defer f.Close()
    send := rpc.NewSender(sndURL, chSnd, true, s.fnLogger)
    go send.Run(ctx)

               w := bufio.NewWriter(f)
               for k, v := range feat {
                  lineStr := fmt.Sprintf("%d->%f", k, v)
                  fmt.Fprintln(w, lineStr)
               }
               w.Flush()
            }
            /////////////////////////////////
    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))

         }
         buf := float32SliceAsByteSlice(feat)
         ioutil.WriteFile("./reid-feat-byte.txt", buf, 0644)
         c.Send(buf)
      }
            //     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])
   return (*[1 << 26]byte)((*[1 << 26]byte)(ptr))[:l:l]
        ch <- data
    } else {
        fn("reid !!!!!! proto.Marshal Out Msg Error:", err)
    }
}