Motion Control Development Guide

#There is a bxi_ws folder in the root directory of the robot controller,which contains the robot motion control program.

#Original project repository. Please read the README.md carefully:
https://github.com/bxirobotics/bxi_rl_controller_ros2_example

# You can change the package name (my_cpp_pkg)
ros2 pkg create my_cpp_pkg --build-type ament_cmake --dependencies rclcpp std_msgs

# include "rclcpp/rclcpp.hpp"
# include "std_msgs/msg/string.hpp"
# include <communication/msg/motion_commands.hpp>
using namespace std::chrono_literals;
class MotionCtrl : public rclcpp::Node
{
public:
    MotionCtrl() : Node("motion_ctrl")
    {
        publisher_  = this->create_publisher<communication::msg::MotionCommands>("/motion_commands", 20);
        timer_ = this->create_wall_timer(500ms, std::bind(&MotionCtrl::timer_callback, this));
    }
private:
    void timer_callback()
    {       
        auto message = communication::msg::MotionCommands();
        message.header.stamp = this->get_clock()->now();
        message.header.frame_id = "";
        message.vel_des.x =  0.5; // forward/backward
        message.yawdot_des =  0.5;// rotation

        publisher_->publish(message);
    }
    rclcpp::Publisher<communication::msg::MotionCommands>::SharedPtr publisher_;
    rclcpp::TimerBase::SharedPtr timer_;
};
int main(int argc, char **argv)
{
    rclcpp::init(argc, argv);
    rclcpp::spin(std::make_shared<MotionCtrl>());
    rclcpp::shutdown();
    return 0;
}

# 添加以下内容
find_package(communication REQUIRED)
add_executable(cpp_node src/main.cpp)
ament_target_dependencies(cpp_node rclcpp std_msgs communication)

install(TARGETS
  cpp_node
  DESTINATION lib/${PROJECT_NAME}
)

# Build first 
# Then run
source install/setup.bash
ros2 run my_cpp_pkg cpp_node

# You can change the package name (my_py_pkg)
ros2 pkg create my_py_pkg --build-type ament_python --dependencies rclpy std_msgs

import rclpy
from rclpy.node import Node
from communication.msg import MotionCommands


class MotionCtrl(Node):
    def __init__(self):
        super().__init__('motion_ctrl')

        self.publisher_ = self.create_publisher(
            MotionCommands,
            '/motion_commands',
            20,
        )
        self.timer = self.create_timer(0.5, self.timer_callback)

    def timer_callback(self):
        message = MotionCommands()

        message.header.stamp = self.get_clock().now().to_msg()
        message.header.frame_id = ''

        message.vel_des.x = 0.5
        message.yawdot_des = 0.5

        self.publisher_.publish(message)

def main(args=None):
    rclpy.init(args=args)
    node = MotionCtrl()

    try:
        rclpy.spin(node)
    finally:
        node.destroy_node()
        rclpy.shutdown()


if __name__ == '__main__':
    main()

<!-- Add this -->
 <depend>communication</depend>

# Modify entry point
entry_points={
    'console_scripts': [
        'motion_ctrl = my_py_pkg.motion_ctrl:main',
    ],
},

#first build
source install/setup.bash
ros2 run my_py_pkg motion_ctrl

systemctl status ros_elf_launch.service

systemctl stop ros_elf_launch.service

systemctl start ros_elf_launch.service

systemctl stop ros_elf_launch.service
sudo systemctl disable ros_elf_launch.service
#This disables auto-start on boot

#!/bin/bash

# Define the process name
PROCESS_NAME="remote_controller"

echo "Attempting to stop process: $PROCESS_NAME ..."

# Get the process PID
# pgrep -f matches the full command line containing the string
PID=$(pgrep -f "$PROCESS_NAME")

if [ -z "$PID" ]; then
    echo "No running process found for $PROCESS_NAME."
else
    echo "Found PID: $PID, sending termination signal..."

    # First try a graceful termination (SIGTERM)
    kill $PID

    # Wait one second and check if it's still running; if so, force kill (SIGKILL)
    sleep 1
    if ps -p $PID > /dev/null; then
        echo "Process did not respond, forcing shutdown (kill -9)..."
        kill -9 $PID
    fi

    echo "Process $PROCESS_NAME has been terminated."
fi