Skip to content
New issue

Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.

By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.

Already on GitHub? Sign in to your account

Feature/humle dual arm demo #373

Open
wants to merge 29 commits into
base: humble
Choose a base branch
from
Open
Show file tree
Hide file tree
Changes from 1 commit
Commits
Show all changes
29 commits
Select commit Hold shift click to select a range
18f32a6
several changes for panda demo
pabloinigoblasco Dec 26, 2022
0fbcc21
panda configs
pabloinigoblasco Dec 26, 2022
f88834a
updating and refactoring code
pabloinigoblasco Dec 26, 2022
55233d1
fixing format check
pabloinigoblasco Dec 26, 2022
7feecea
fixing format
pabloinigoblasco Dec 26, 2022
088e58a
missing
pabloinigoblasco Dec 26, 2022
40a900b
fixing format
pabloinigoblasco Dec 26, 2022
942a341
format fix
pabloinigoblasco Dec 26, 2022
eb562d9
humble moveit environment
pabloinigoblasco Dec 26, 2022
3efdbf0
fixes
pabloinigoblasco Dec 27, 2022
3ccc0df
missing
pabloinigoblasco Dec 27, 2022
4af6f12
updating format
pabloinigoblasco Dec 27, 2022
4569193
minor
pabloinigoblasco Dec 28, 2022
62af4bf
Merge branch 'humble' into feature/humle_dual_arm_demo
pabloinigoblasco Dec 28, 2022
434f02e
missing
pabloinigoblasco Dec 30, 2022
dbe43de
missing
pabloinigoblasco Dec 30, 2022
12b9097
fix
pabloinigoblasco Dec 30, 2022
70a2b4c
fixing
pabloinigoblasco Dec 30, 2022
82665d3
format fix
pabloinigoblasco Dec 30, 2022
76e053d
missing repo
pabloinigoblasco Jan 9, 2023
a7e60ec
minor
pabloinigoblasco Jan 9, 2023
de33adc
fixing humble build
pabloinigoblasco Jan 9, 2023
a073864
missing
pabloinigoblasco Jan 9, 2023
ad56f28
Merge branch 'humble' into feature/humle_dual_arm_demo
pabloinigoblasco Jan 11, 2023
47415af
minor format fix
pabloinigoblasco Jan 11, 2023
b543af0
docker making it work
pabloinigoblasco Jan 11, 2023
48605bb
minor
pabloinigoblasco Jan 15, 2023
97abf9e
updating branch
pabloinigoblasco Jan 25, 2023
2e9ec9f
Merge branch 'humble' into feature/humle_dual_arm_demo
pabloinigoblasco Feb 1, 2023
File filter

Filter by extension

Filter by extension

Conversations
Failed to load comments.
Loading
Jump to
Jump to file
Failed to load files.
Loading
Diff view
Diff view
Prev Previous commit
Next Next commit
fixing format
  • Loading branch information
pabloinigoblasco committed Dec 26, 2022
commit 7feecea18af4257a74f41e7b811f3031d4481dca
Original file line number Diff line number Diff line change
@@ -1,3 1,17 @@
# Copyright 2021 RobosoftAI Inc.
#
# Licensed under the Apache License, Version 2.0 (the "License");
# you may not use this file except in compliance with the License.
# You may obtain a copy of the License at
#
# http://www.apache.org/licenses/LICENSE-2.0
#
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS,
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
# See the License for the specific language governing permissions and
# limitations under the License.

import os
from launch import LaunchDescription
from launch.actions import DeclareLaunchArgument
Expand Down
Original file line number Diff line number Diff line change
@@ -1,3 1,17 @@
# Copyright 2021 RobosoftAI Inc.
#
# Licensed under the Apache License, Version 2.0 (the "License");
# you may not use this file except in compliance with the License.
# You may obtain a copy of the License at
#
# http://www.apache.org/licenses/LICENSE-2.0
#
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS,
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
# See the License for the specific language governing permissions and
# limitations under the License.

import os
from launch import LaunchDescription
from launch.actions import DeclareLaunchArgument
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -33,7 33,7 @@ class OrArmLeft : public smacc2::Orthogonal<OrArmLeft>
public:
void onInitialize() override
{

moveit::planning_interface::MoveGroupInterface::Options options ("left_panda_arm","robot_description_left", "/panda_arm_1");


Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -33,7 33,7 @@ class OrArmRight : public smacc2::Orthogonal<OrArmRight>
public:
void onInitialize() override
{

moveit::planning_interface::MoveGroupInterface::Options options ("right_panda_arm","robot_description", "/panda_arm_2");

auto move_group_client = this->createClient<cl_move_group_interface::ClMoveGroup>(options); //ur_manipulator
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -141,4 141,4 @@ struct SmMultiPandaSim : public smacc2::SmaccStateMachineBase<SmMultiPandaSim, S

#include "states/st_left_arm_moves.hpp"
#include "states/st_right_arm_moves.hpp"
#include "states/st_both_arms_move.hpp"
#include "states/st_both_arms_move.hpp"
Original file line number Diff line number Diff line change
Expand Up @@ -47,7 47,7 @@ struct StAcquireSensors : smacc2::SmaccState<StAcquireSensors, SmMultiPandaSim>
>reactions;

// STATE FUNCTIONS
static void staticConfigure()
static void staticConfigure()
{
configure_orthogonal<OrArmLeft, CbWaitJointState>();
}
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -41,7 41,7 @@ struct StBothArmsMove : smacc2::SmaccState<StBothArmsMove, SmMultiPandaSim>
// STATE FUNCTIONS
static void staticConfigure()
{


std::map<std::string, double> rightJointValues{ { "right_panda_joint1", -0.3 },
{ "right_panda_joint2", -0.3 },
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -43,7 43,7 @@ struct StLeftArmMoves : smacc2::SmaccState<StLeftArmMoves, SmMultiPandaSim>
// STATE FUNCTIONS
static void staticConfigure()
{


std::map<std::string, double> leftJointValues{
{ "left_panda_joint1", 0.1 },
Expand All @@ -59,7 59,7 @@ struct StLeftArmMoves : smacc2::SmaccState<StLeftArmMoves, SmMultiPandaSim>
void runtimeConfigure()
{
this->getClientBehavior<OrArmLeft, CbMoveJoints>()->scalingFactor_=100;

// std::map<std::string, double> leftJointValues{
// { "left_panda_joint1", 0.1 },
// { "left_panda_joint2", 0.1 },
Expand Down
Original file line number Diff line number Diff line change
Expand Up @@ -42,7 42,7 @@ struct StRightArmMoves : smacc2::SmaccState<StRightArmMoves, SmMultiPandaSim>
// STATE FUNCTIONS
static void staticConfigure()
{


std::map<std::string, double> rightJointValues{ { "right_panda_joint1", 0.1 },
{ "right_panda_joint2", 0.1 },
Expand Down
Original file line number Diff line number Diff line change
@@ -1,15 1,44 @@
# Copyright 2021 RobosoftAI Inc.
#
# Licensed under the Apache License, Version 2.0 (the "License");
# you may not use this file except in compliance with the License.
# You may obtain a copy of the License at
#
# http://www.apache.org/licenses/LICENSE-2.0
#
# Unless required by applicable law or agreed to in writing, software
# distributed under the License is distributed on an "AS IS" BASIS,
# WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
# See the License for the specific language governing permissions and
# limitations under the License.

import os
from launch import LaunchDescription
from ament_index_python.packages import get_package_share_directory
from launch.launch_description_sources import AnyLaunchDescriptionSource

from launch.actions import IncludeLaunchDescription


def generate_launch_description():
panda_arm_1 = IncludeLaunchDescription(
AnyLaunchDescriptionSource(os.path.join(get_package_share_directory('panda_arm_1_moveit_config'), 'launch', 'demo.launch.py')))
AnyLaunchDescriptionSource(
os.path.join(
get_package_share_directory("panda_arm_1_moveit_config"),
"launch",
"demo.launch.py",
)
)
)

panda_arm_2 = IncludeLaunchDescription(
AnyLaunchDescriptionSource(os.path.join(get_package_share_directory('panda_arm_2_moveit_config'), 'launch', 'demo.launch.py')))
AnyLaunchDescriptionSource(
os.path.join(
get_package_share_directory("panda_arm_2_moveit_config"),
"launch",
"demo.launch.py",
)
)
)

return LaunchDescription([panda_arm_1, panda_arm_2])
return LaunchDescription([panda_arm_1, panda_arm_2])