|
@@ -0,0 +1,189 @@
|
|
|
|
|
+package mcu_ctrl_board
|
|
|
|
|
+
|
|
|
|
|
+/*
|
|
|
|
|
+#include "mcu_ctrl_board.h"
|
|
|
|
|
+*/
|
|
|
|
|
+import "C"
|
|
|
|
|
+
|
|
|
|
|
+import (
|
|
|
|
|
+ "encoding/json"
|
|
|
|
|
+ "fmt"
|
|
|
|
|
+ "sync"
|
|
|
|
|
+ "time"
|
|
|
|
|
+
|
|
|
|
|
+ "hnyfkj.com.cn/rtu/linux/baseapp"
|
|
|
|
|
+ "hnyfkj.com.cn/rtu/linux/utils/jsonrpc2"
|
|
|
|
|
+)
|
|
|
|
|
+
|
|
|
|
|
+var (
|
|
|
|
|
+ // 存储所有待处理的JSON RPC 2.0请求ID和对应的应答通道
|
|
|
|
|
+ pendingRequests sync.Map
|
|
|
|
|
+)
|
|
|
|
|
+
|
|
|
|
|
+// 判断报文的角色是什么
|
|
|
|
|
+func detectRPC2Role(jsonStr string) string {
|
|
|
|
|
+ var obj map[string]json.RawMessage
|
|
|
|
|
+ if json.Unmarshal([]byte(jsonStr), &obj) != nil {
|
|
|
|
|
+ return "invalid"
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ if string(obj["jsonrpc"]) != `"2.0"` {
|
|
|
|
|
+ return "unknown"
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ switch {
|
|
|
|
|
+ case obj["method"] != nil:
|
|
|
|
|
+ return "request"
|
|
|
|
|
+ case obj["result"] != nil || obj["error"] != nil:
|
|
|
|
|
+ return "response"
|
|
|
|
|
+ default:
|
|
|
|
|
+ return "unknown"
|
|
|
|
|
+ }
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+// 发送通知, 不用等应答
|
|
|
|
|
+func SendRPC2Notify(req *jsonrpc2.Request) error {
|
|
|
|
|
+ if req == nil || req.ID != nil {
|
|
|
|
|
+ return fmt.Errorf("invalid notify request")
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ jsonStr, err := req.String()
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ return err
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ _, err = McuCtrlBoard_Write([]byte(jsonStr))
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ return err
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ return nil
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+// 发送请求, 并等待应答
|
|
|
|
|
+func SendRPC2Request(req *jsonrpc2.Request, timeout int /*单位: ms*/) (*jsonrpc2.Response, error) {
|
|
|
|
|
+ if req == nil || req.ID == nil {
|
|
|
|
|
+ return nil, fmt.Errorf("invalid request or request ID")
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ id := *req.ID
|
|
|
|
|
+ ch := make(chan *jsonrpc2.Response, 1)
|
|
|
|
|
+ pendingRequests.Store(id, ch)
|
|
|
|
|
+ defer pendingRequests.Delete(id)
|
|
|
|
|
+
|
|
|
|
|
+ jsonStr, err := req.String()
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ return nil, err
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ _, err = McuCtrlBoard_Write([]byte(jsonStr))
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ return nil, err
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ timer := time.NewTimer(time.Duration(timeout) * time.Millisecond)
|
|
|
|
|
+ defer timer.Stop()
|
|
|
|
|
+
|
|
|
|
|
+ select {
|
|
|
|
|
+ case resp := <-ch:
|
|
|
|
|
+ return resp, nil
|
|
|
|
|
+ case <-timer.C:
|
|
|
|
|
+ return nil, fmt.Errorf("request %v timed out after %d ms", id, timeout)
|
|
|
|
|
+ }
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+// 主动发出请求的应答
|
|
|
|
|
+func handleRPC2Response(jsonStr string) error {
|
|
|
|
|
+ w, err := jsonrpc2.ParseResponse(jsonStr)
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ return fmt.Errorf("an error occurred while parsing JSON-RPC response: %v", err)
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ if w.ID == nil {
|
|
|
|
|
+ return nil
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ id := *w.ID
|
|
|
|
|
+
|
|
|
|
|
+ v, ok := pendingRequests.Load(id)
|
|
|
|
|
+ if !ok {
|
|
|
|
|
+ return fmt.Errorf("orphan response id=%d, no pending request", id)
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ ch, ok := v.(chan *jsonrpc2.Response)
|
|
|
|
|
+ if !ok {
|
|
|
|
|
+ return fmt.Errorf("invalid response channel for id=%d", id)
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ select {
|
|
|
|
|
+ case ch <- w:
|
|
|
|
|
+ return nil
|
|
|
|
|
+ default:
|
|
|
|
|
+ return fmt.Errorf("response dropped for id=%d, channel not receiving", id)
|
|
|
|
|
+ }
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+// 处理JSONRPC 2.0报文
|
|
|
|
|
+func processRPC2(jsonStr string) *C.char {
|
|
|
|
|
+ s := jsonStr
|
|
|
|
|
+ role := detectRPC2Role(s)
|
|
|
|
|
+
|
|
|
|
|
+ var w *jsonrpc2.Response
|
|
|
|
|
+
|
|
|
|
|
+ wret := func() *C.char {
|
|
|
|
|
+ if w == nil { // 无应答
|
|
|
|
|
+ return nil
|
|
|
|
|
+ }
|
|
|
|
|
+ // 下面由C.CString()分配的堆内存由C侧释放
|
|
|
|
|
+ b, err := w.String()
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ return C.CString(fmt.Sprintf("an error occurred while calling the String() method of jsonrpc2.Response: %v", err))
|
|
|
|
|
+ }
|
|
|
|
|
+ return C.CString(b)
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ if role == "response" {
|
|
|
|
|
+ err := handleRPC2Response(s)
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ baseapp.Logger.Errorf("[%s] 解析控制板返回的应答时发生错误: %v", MODULE_NAME, err)
|
|
|
|
|
+ }
|
|
|
|
|
+ return nil
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ if role != "request" {
|
|
|
|
|
+ w = jsonrpc2.BuildError(nil, jsonrpc2.ErrInvalidRequest, "")
|
|
|
|
|
+ return wret()
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ r, err := jsonrpc2.ParseRequest(s)
|
|
|
|
|
+
|
|
|
|
|
+ call := func(f func(*jsonrpc2.Request) (*jsonrpc2.Response, error)) *jsonrpc2.Response {
|
|
|
|
|
+ w, e := f(r)
|
|
|
|
|
+ if e != nil { // 调用本地RPC处理函数时发生错误
|
|
|
|
|
+ return jsonrpc2.BuildError(r, jsonrpc2.ErrInternal, "")
|
|
|
|
|
+ }
|
|
|
|
|
+ return w
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ if err != nil {
|
|
|
|
|
+ w = jsonrpc2.BuildError(nil, jsonrpc2.ErrParse, "")
|
|
|
|
|
+ } else {
|
|
|
|
|
+ switch r.Method {
|
|
|
|
|
+ case "echo":
|
|
|
|
|
+ w = call(test_echo)
|
|
|
|
|
+ default:
|
|
|
|
|
+ w = jsonrpc2.BuildError(r, jsonrpc2.ErrMethodNotFound, "")
|
|
|
|
|
+ }
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ return wret()
|
|
|
|
|
+}
|
|
|
|
|
+
|
|
|
|
|
+// 文本回显本地测试方法
|
|
|
|
|
+func test_echo(r *jsonrpc2.Request) (*jsonrpc2.Response, error) {
|
|
|
|
|
+ if r.Params == nil {
|
|
|
|
|
+ return jsonrpc2.BuildError(r, jsonrpc2.ErrInvalidParams, ""), nil
|
|
|
|
|
+ }
|
|
|
|
|
+
|
|
|
|
|
+ return jsonrpc2.BuildResult(r, r.Params)
|
|
|
|
|
+}
|