云迹机器人底盘调用还是比较友好的,就是纯socket收发指令就能实现,今天实现一个底盘移动到指定点位功能。底盘的默认IP是192.168.10.10通讯端口是31001,测试机与底盘接入统一网络后直接发指令即可。本文给出两种语言调用源码,选择一种使用即可。

python调用源码:

import socket
import json

yunji_ip = "192.168.10.10"#设定地盘ip地址,需要根据机器人实际ip地址修改

#底盘-移动到指定为止
def YunjiGo(target):
    print(f"---------------------YunjiGo:{target}---------------------")

    port = 31001
    command = "/api/move?marker=" + target + "&distance_tolerance=0&theta_tolerance=0"

    client = socket.socket()
    client.connect((yunji_ip, port))
    print(f"command:{command}")
    client.send(command.encode())

    while True:
        try:
            data = client.recv(1024)
            if not data:
                print("Socket closed by peer.")
                return None

            str_data = data.decode('utf-8')
            split_data = [s for s in str_data.split('\n') if s]

            for s in split_data:
                try:
                    json_data = json.loads(s)
                    print(json_data.get("description"))

                    # 检查条件:任务完成且目标匹配
                    if (
                        json_data.get("description") == "The move task is finished."
                        and "data" in json_data
                        and "target" in json_data["data"]
                        and json_data["data"]["target"] == target
                    ):
                        print("Task finished successfully!")
                        client.close()  # 关闭 socket
                        return True     # 返回成功

                except json.JSONDecodeError:
                    print("Invalid JSON data, continue waiting...")
                    continue

        except socket.timeout:
            print("Timeout reached, no matching data received.")
            return None
        except Exception as e:
            print(f"Error occurred: {e}")
            client.close()  # 确保异常时关闭 socket
            return None
YunjiGo("huahua")#移动到点位huahua

JAVA调用源码:(需要下载org.json-20161124.jar)

package examples;
import java.io.*;
import java.net.*;
import org.json.JSONObject;
import org.json.JSONException;

/*
依赖安装:
sudo apt update
sudo apt install language-pack-zh-hans  # 简体中文
sudo apt install fonts-noto-cjk        # 中文字体
sudo apt install default-jdk

*/

//make:
/*
cd /home/java
javac -encoding UTF-8 -cp .:\
org.json-20161124.jar \
examples/RobotControl.java
*/
//run : 
/*
cd /home/java
java -Dfile.encoding=UTF-8 -cp .:\
org.json-20161124.jar \
examples.RobotControl
*/

public class RobotControl {
    String yunji_ip  = "192.168.10.10";  // 底盘ip地址
    int yunji_port = 31001;//底盘通讯端口

    private static RobotControl mInstance =null;

    public static synchronized RobotControl getInstance() 
    {
        if (mInstance == null) {
            mInstance = new RobotControl();
        }
        return mInstance;
    }


    //底盘移动
    public void YunjiGo(String target) throws Exception
    {
        String command = "/api/move?marker=" + target + "&distance_tolerance=0.01&theta_tolerance=0.01";

        try {
            Socket client = new Socket(yunji_ip, yunji_port);
            //System.out.println("command:" + command);
            OutputStream out = client.getOutputStream();
            out.write(command.getBytes());
            out.flush();

            InputStream in = client.getInputStream();
            BufferedReader reader = new BufferedReader(new InputStreamReader(in));

            String strData;
            while ((strData = reader.readLine()) != null) {
                //System.out.println("strData:" + strData);
                try {
                    JSONObject jsonData = new JSONObject(strData);
                    System.out.println(jsonData.optString("description"));

                    // 检查条件:任务完成且目标匹配
                    if (jsonData.optString("description").equals("The move task is finished.")
                            && jsonData.has("data")
                            && jsonData.getJSONObject("data").has("target")
                            && jsonData.getJSONObject("data").getString("target").equals(target)) {
                        System.out.println("Task finished successfully!");
                        client.close(); // 关闭 socket
                        return;    // 返回成功
                    }
                } catch (JSONException e) {
                    System.out.println("Invalid JSON data, continue waiting...");
                    continue;
                }
            }

            throw new Exception("Socket closed by peer.");
        } catch (SocketTimeoutException e) {
            throw new Exception("Timeout reached, no matching data received.");
        } catch (Exception e) {
            throw new Exception("Error occurred: " + e.getMessage());
        }
    }

    public static void main(String[] args) {  
        RobotControl robotControl = RobotControl.getInstance();

        try
        {
            System.out.println("------------YunjiGo------------");
            robotControl.YunjiGo("huahua");
        } catch (Exception e) {
            System.out.println("YunjiGo Error occurred: " + e.getMessage());
        }
        System.out.println();
    }
}

运行输出:


------------YunjiGo------------

The move task is started.
Start to leave charging pile..
Charge status off.
Succeed to leave charging pile.
traffic turn right.
traffic turn right.
The move task is finished.
Task finished successfully!

Logo

DAMO开发者矩阵,由阿里巴巴达摩院和中国互联网协会联合发起,致力于探讨最前沿的技术趋势与应用成果,搭建高质量的交流与分享平台,推动技术创新与产业应用链接,围绕“人工智能与新型计算”构建开放共享的开发者生态。

更多推荐