Text this: The Simulation and Trajectory Planning of the SensoRob Mani Robot in ROS2