mirror of
https://github.com/soconnor0919/hristudio.git
synced 2026-03-24 03:37:51 -04:00
Restore builtins for standard ROS actions
- Re-add say_text, walk_forward, walk_backward, turn_left, turn_right, move_head, turn_head as builtins - These use standard ROS topics (/speech, /cmd_vel, /joint_angles) that work with most robots - Plugin-specific actions should still be defined in plugin config
This commit is contained in:
@@ -451,6 +451,59 @@ export class WizardRosService extends EventEmitter {
|
||||
parameters: Record<string, unknown>,
|
||||
): Promise<void> {
|
||||
switch (actionId) {
|
||||
case "say_text":
|
||||
const text = String(parameters.text || "Hello");
|
||||
this.publish("/speech", "std_msgs/String", { data: text });
|
||||
const wordCount = text.split(/\s+/).length;
|
||||
const duration = Math.max(800, wordCount * 250 + 500);
|
||||
await new Promise((resolve) => setTimeout(resolve, duration));
|
||||
break;
|
||||
|
||||
case "walk_forward":
|
||||
this.publish("/cmd_vel", "geometry_msgs/Twist", {
|
||||
linear: { x: Number(parameters.speed) || 0.1, y: 0, z: 0 },
|
||||
angular: { x: 0, y: 0, z: 0 },
|
||||
});
|
||||
await new Promise((resolve) => setTimeout(resolve, 500));
|
||||
break;
|
||||
|
||||
case "walk_backward":
|
||||
this.publish("/cmd_vel", "geometry_msgs/Twist", {
|
||||
linear: { x: -(Number(parameters.speed) || 0.1), y: 0, z: 0 },
|
||||
angular: { x: 0, y: 0, z: 0 },
|
||||
});
|
||||
await new Promise((resolve) => setTimeout(resolve, 500));
|
||||
break;
|
||||
|
||||
case "turn_left":
|
||||
this.publish("/cmd_vel", "geometry_msgs/Twist", {
|
||||
linear: { x: 0, y: 0, z: 0 },
|
||||
angular: { x: 0, y: 0, z: -(Number(parameters.speed) || 0.3) },
|
||||
});
|
||||
await new Promise((resolve) => setTimeout(resolve, 500));
|
||||
break;
|
||||
|
||||
case "turn_right":
|
||||
this.publish("/cmd_vel", "geometry_msgs/Twist", {
|
||||
linear: { x: 0, y: 0, z: 0 },
|
||||
angular: { x: 0, y: 0, z: Number(parameters.speed) || 0.3 },
|
||||
});
|
||||
await new Promise((resolve) => setTimeout(resolve, 500));
|
||||
break;
|
||||
|
||||
case "move_head":
|
||||
case "turn_head":
|
||||
this.publish("/joint_angles", "naoqi_bridge_msgs/JointAnglesWithSpeed", {
|
||||
joint_names: ["HeadYaw", "HeadPitch"],
|
||||
joint_angles: [
|
||||
Number(parameters.yaw) || 0,
|
||||
Number(parameters.pitch) || 0,
|
||||
],
|
||||
speed: Number(parameters.speed) || 0.3,
|
||||
});
|
||||
await new Promise((resolve) => setTimeout(resolve, 1000));
|
||||
break;
|
||||
|
||||
case "emergency_stop":
|
||||
this.publish("/cmd_vel", "geometry_msgs/Twist", {
|
||||
linear: { x: 0, y: 0, z: 0 },
|
||||
|
||||
Reference in New Issue
Block a user