Tune parameters
This commit is contained in:
@@ -60,7 +60,7 @@ DummyController echoes Motion messages to the terminal.
|
|||||||
ros2 run robot_controller dummy_controller
|
ros2 run robot_controller dummy_controller
|
||||||
```
|
```
|
||||||
|
|
||||||
AxidrawController draws on the axidraw robot
|
AxidrawController draws on the axidraw robot.
|
||||||
Find the serial device in "/dev/", it is usually named "/dev/ttyACMX" where X is usually 0.
|
Find the serial device in "/dev/", it is usually named "/dev/ttyACMX" where X is usually 0.
|
||||||
``` sh
|
``` sh
|
||||||
ros2 launch axidraw_controller axidraw_controller serial_port:=/dev/ttyACM0
|
ros2 launch axidraw_controller axidraw_controller serial_port:=/dev/ttyACM0
|
||||||
|
|||||||
@@ -4,31 +4,31 @@
|
|||||||
joint_limits:
|
joint_limits:
|
||||||
joint1:
|
joint1:
|
||||||
has_velocity_limits: true
|
has_velocity_limits: true
|
||||||
max_velocity: 3.14
|
max_velocity: 10.14
|
||||||
has_acceleration_limits: true
|
has_acceleration_limits: true
|
||||||
max_acceleration: 20.0
|
max_acceleration: 20.0
|
||||||
joint2:
|
joint2:
|
||||||
has_velocity_limits: true
|
has_velocity_limits: true
|
||||||
max_velocity: 3.14
|
max_velocity: 10.14
|
||||||
has_acceleration_limits: true
|
has_acceleration_limits: true
|
||||||
max_acceleration: 20.0
|
max_acceleration: 20.0
|
||||||
joint3:
|
joint3:
|
||||||
has_velocity_limits: true
|
has_velocity_limits: true
|
||||||
max_velocity: 3.14
|
max_velocity: 10.14
|
||||||
has_acceleration_limits: true
|
has_acceleration_limits: true
|
||||||
max_acceleration: 20.0
|
max_acceleration: 20.0
|
||||||
joint4:
|
joint4:
|
||||||
has_velocity_limits: true
|
has_velocity_limits: true
|
||||||
max_velocity: 3.14
|
max_velocity: 10.14
|
||||||
has_acceleration_limits: true
|
has_acceleration_limits: true
|
||||||
max_acceleration: 20.0
|
max_acceleration: 20.0
|
||||||
joint5:
|
joint5:
|
||||||
has_velocity_limits: true
|
has_velocity_limits: true
|
||||||
max_velocity: 3.14
|
max_velocity: 10.14
|
||||||
has_acceleration_limits: true
|
has_acceleration_limits: true
|
||||||
max_acceleration: 20.0
|
max_acceleration: 20.0
|
||||||
joint6:
|
joint6:
|
||||||
has_velocity_limits: true
|
has_velocity_limits: true
|
||||||
max_velocity: 3.14
|
max_velocity: 10.14
|
||||||
has_acceleration_limits: true
|
has_acceleration_limits: true
|
||||||
max_acceleration: 20.0
|
max_acceleration: 20.0
|
||||||
|
|||||||
@@ -198,7 +198,7 @@ class SVGProcessor():
|
|||||||
"""
|
"""
|
||||||
# For RDP, Try an epsilon of 1.0 to start with. Other sensible values include 0.01, 0.001
|
# For RDP, Try an epsilon of 1.0 to start with. Other sensible values include 0.01, 0.001
|
||||||
#epsilon = 0.009
|
#epsilon = 0.009
|
||||||
epsilon = 0.005
|
epsilon = 0.0005
|
||||||
|
|
||||||
tmp = []
|
tmp = []
|
||||||
out = []
|
out = []
|
||||||
|
|||||||
@@ -89,8 +89,8 @@ public:
|
|||||||
float xlim_upper = 0.305;
|
float xlim_upper = 0.305;
|
||||||
float ylim_lower = -0.1475;
|
float ylim_lower = -0.1475;
|
||||||
float ylim_upper = 0.1475;
|
float ylim_upper = 0.1475;
|
||||||
float zlim_lower = 0.210;
|
float zlim_lower = 0.1945;
|
||||||
float zlim_upper = 0.218;
|
float zlim_upper = 0.200;
|
||||||
|
|
||||||
//bool moved = false;
|
//bool moved = false;
|
||||||
//
|
//
|
||||||
@@ -121,8 +121,8 @@ public:
|
|||||||
this->move_group.setMaxAccelerationScalingFactor(1.0);
|
this->move_group.setMaxAccelerationScalingFactor(1.0);
|
||||||
|
|
||||||
//setting this lower seems to improve overall time and prevents robot from moving too fast
|
//setting this lower seems to improve overall time and prevents robot from moving too fast
|
||||||
//this->move_group.setMaxVelocityScalingFactor(1.0);
|
this->move_group.setMaxVelocityScalingFactor(1.0);
|
||||||
this->move_group.setMaxVelocityScalingFactor(0.8);
|
//this->move_group.setMaxVelocityScalingFactor(0.8);
|
||||||
|
|
||||||
// Subscribe to target pose
|
// Subscribe to target pose
|
||||||
//target_pose_sub_ = this->create_subscription<geometry_msgs::msg::PoseStamped>("/target_pose", rclcpp::QoS(1), std::bind(&MoveItFollowTarget::target_pose_callback, this, std::placeholders::_1));
|
//target_pose_sub_ = this->create_subscription<geometry_msgs::msg::PoseStamped>("/target_pose", rclcpp::QoS(1), std::bind(&MoveItFollowTarget::target_pose_callback, this, std::placeholders::_1));
|
||||||
@@ -237,7 +237,7 @@ public:
|
|||||||
mpr.planner_id = "LIN";
|
mpr.planner_id = "LIN";
|
||||||
mpr.group_name = move_group.getName();
|
mpr.group_name = move_group.getName();
|
||||||
//mpr.max_velocity_scaling_factor = 1.0;
|
//mpr.max_velocity_scaling_factor = 1.0;
|
||||||
mpr.max_velocity_scaling_factor = 0.7;
|
mpr.max_velocity_scaling_factor = 0.3;
|
||||||
mpr.max_acceleration_scaling_factor = 0.4;
|
mpr.max_acceleration_scaling_factor = 0.4;
|
||||||
//mpr.max_acceleration_scaling_factor = 0.1;
|
//mpr.max_acceleration_scaling_factor = 0.1;
|
||||||
mpr.allowed_planning_time = 10;
|
mpr.allowed_planning_time = 10;
|
||||||
|
|||||||
@@ -73,7 +73,7 @@ class DrawingApp(tk.Tk):
|
|||||||
def draw(self,x,y,z):
|
def draw(self,x,y,z):
|
||||||
# putpixel is too slow
|
# putpixel is too slow
|
||||||
#self.img.putpixel((int(x), int(y)), (255, 0, 0))
|
#self.img.putpixel((int(x), int(y)), (255, 0, 0))
|
||||||
r = 4 # radius
|
r = 3 # radius
|
||||||
for xp in range(max(0, x-r), min(self.width-1, x+r)):
|
for xp in range(max(0, x-r), min(self.width-1, x+r)):
|
||||||
for yp in range(max(0, y-r), min(self.height-1, y+r)):
|
for yp in range(max(0, y-r), min(self.height-1, y+r)):
|
||||||
self.arr[xp,yp,0] = 0 #red
|
self.arr[xp,yp,0] = 0 #red
|
||||||
@@ -105,7 +105,7 @@ class DrawingApp(tk.Tk):
|
|||||||
#y = translate(p.y, -0.51, -0.3, 0, self.height)
|
#y = translate(p.y, -0.51, -0.3, 0, self.height)
|
||||||
|
|
||||||
x = int(translate(p.y, -0.5, 0.5, 0, self.width))
|
x = int(translate(p.y, -0.5, 0.5, 0, self.width))
|
||||||
y = int(translate(p.x, -0.3485, 0.1, 0, self.height))
|
y = int(translate(p.x, -0.2485, 0.1, 0, self.height))
|
||||||
|
|
||||||
#x = bound(self.width - x, 0, self.width)
|
#x = bound(self.width - x, 0, self.width)
|
||||||
#y = bound(self.height - y, 0, self.height)
|
#y = bound(self.height - y, 0, self.height)
|
||||||
|
|||||||
Reference in New Issue
Block a user