diff --git a/consai_ros2/consai_visualizer/resource/visualizer.ui b/consai_ros2/consai_visualizer/resource/visualizer.ui index 41cc13aa5..a02a3d780 100644 --- a/consai_ros2/consai_visualizer/resource/visualizer.ui +++ b/consai_ros2/consai_visualizer/resource/visualizer.ui @@ -639,2084 +639,2102 @@ - - - - - Y2 - - - false - - - radio_buttons - - - - - - - - - - - - 0 - 0 - 0 - - - - - - - 53 - 132 - 228 - - - - - - - 146 - 195 - 255 - - - - - - - 99 - 163 - 241 - - - - - - - 26 - 66 - 114 - - - - - - - 35 - 88 - 152 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 53 - 132 - 228 - - - - - - - 0 - 0 - 0 - - - - - - - 154 - 193 - 241 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 0 - 0 - 0 - - - - - - - 53 - 132 - 228 - - - - - - - 146 - 195 - 255 - - - - - - - 99 - 163 - 241 - - - - - - - 26 - 66 - 114 - - - - - - - 35 - 88 - 152 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 53 - 132 - 228 - - - - - - - 0 - 0 - 0 - - - - - - - 154 - 193 - 241 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 26 - 66 - 114 - - - - - - - 53 - 132 - 228 - - - - - - - 146 - 195 - 255 - - - - - - - 99 - 163 - 241 - - - - - - - 26 - 66 - 114 - - - - - - - 35 - 88 - 152 - - - - - - - 26 - 66 - 114 - - - - - - - 255 - 255 - 255 - - - - - - - 26 - 66 - 114 - - - - - - - 53 - 132 - 228 - - - - - - - 53 - 132 - 228 - - - - - - - 0 - 0 - 0 - - - - - - - 53 - 132 - 228 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - All ON - - - - - - - B10 - - - radio_buttons - - - - - - - - - - - - 0 - 0 - 0 - - - - - - - 53 - 132 - 228 - - - - - - - 146 - 195 - 255 - - - - - - - 99 - 163 - 241 - - - - - - - 26 - 66 - 114 - - - - - - - 35 - 88 - 152 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 53 - 132 - 228 - - - - - - - 0 - 0 - 0 - - - - - - - 154 - 193 - 241 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 0 - 0 - 0 - - - - - - - 53 - 132 - 228 - - - - - - - 146 - 195 - 255 - - - - - - - 99 - 163 - 241 - - - - - - - 26 - 66 - 114 - - - - - - - 35 - 88 - 152 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 53 - 132 - 228 - - - - - - - 0 - 0 - 0 - - - - - - - 154 - 193 - 241 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 26 - 66 - 114 - - - - - - - 53 - 132 - 228 - - - - - - - 146 - 195 - 255 - - - - - - - 99 - 163 - 241 - - - - - - - 26 - 66 - 114 - - - - - - - 35 - 88 - 152 - - - - - - - 26 - 66 - 114 - - - - - - - 255 - 255 - 255 - - - - - - - 26 - 66 - 114 - - - - - - - 53 - 132 - 228 - - - - - - - 53 - 132 - 228 - - - - - - - 0 - 0 - 0 - - - - - - - 53 - 132 - 228 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - All OFF - - - - - - - - - - - - 0 - 0 - 0 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 239 - 161 - - - - - - - 250 - 225 - 103 - - - - - - - 123 - 105 - 22 - - - - - - - 164 - 141 - 30 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 246 - 211 - 45 - - - - - - - 0 - 0 - 0 - - - - - - - 250 - 233 - 150 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 0 - 0 - 0 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 239 - 161 - - - - - - - 250 - 225 - 103 - - - - - - - 123 - 105 - 22 - - - - - - - 164 - 141 - 30 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 246 - 211 - 45 - - - - - - - 0 - 0 - 0 - - - - - - - 250 - 233 - 150 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 123 - 105 - 22 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 239 - 161 - - - - - - - 250 - 225 - 103 - - - - - - - 123 - 105 - 22 - - - - - - - 164 - 141 - 30 - - - - - - - 123 - 105 - 22 - - - - - - - 255 - 255 - 255 - - - - - - - 123 - 105 - 22 - - - - - - - 246 - 211 - 45 - - - - - - - 246 - 211 - 45 - - - - - - - 0 - 0 - 0 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - All OFF - - - - - - - Y3 - - - false - - - radio_buttons - - - - - - - B3 - - - radio_buttons - - - - - - - B8 - - - radio_buttons - - - - - - - Y10 - - - false - - - radio_buttons - - - - - - - Y8 - - - false - - - radio_buttons - - - - - - - Y5 - - - false - - - radio_buttons - - - - - - - B9 - - - radio_buttons - - - - - - - Y9 - - - false - - - radio_buttons - - - - - - - - - - - - 0 - 0 - 0 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 239 - 161 - - - - - - - 250 - 225 - 103 - - - - - - - 123 - 105 - 22 - - - - - - - 164 - 141 - 30 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 246 - 211 - 45 - - - - - - - 0 - 0 - 0 - - - - - - - 250 - 233 - 150 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 0 - 0 - 0 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 239 - 161 - - - - - - - 250 - 225 - 103 - - - - - - - 123 - 105 - 22 - - - - - - - 164 - 141 - 30 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 0 - 0 - 0 - - - - - - - 255 - 255 - 255 - - - - - - - 246 - 211 - 45 - - - - - - - 0 - 0 - 0 - - - - - - - 250 - 233 - 150 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - - 123 - 105 - 22 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 239 - 161 - - - - - - - 250 - 225 - 103 - - - - - - - 123 - 105 - 22 - - - - - - - 164 - 141 - 30 - - - - - - - 123 - 105 - 22 - - - - - - - 255 - 255 - 255 - - - - - - - 123 - 105 - 22 - - - - - - - 246 - 211 - 45 - - - - - - - 246 - 211 - 45 - - - - - - - 0 - 0 - 0 - - - - - - - 246 - 211 - 45 - - - - - - - 255 - 255 - 220 - - - - - - - 0 - 0 - 0 - - - - - - - 0 - 0 - 0 - - - - - - - - All ON - - - - - - - B6 - - - radio_buttons - - - - - - - Y1 - - - false - - - radio_buttons - - - - - - - B0 - - - false - - - radio_buttons - - - - - - - B7 - - - radio_buttons - - - - - - - Y7 - - - false - - - radio_buttons - - - - - - - B4 - - - radio_buttons - - - - - - - Y4 - - - false - - - radio_buttons - - - - - - - Y6 - - - false - - - radio_buttons - - - - - - - B2 - - - radio_buttons - - - - - - - Y0 - - - radio_buttons - - - - - - - B1 - - - false - - - radio_buttons - - - - - - - B5 - - - radio_buttons - - - - - - - Ball - - - true - - - radio_buttons - - + + + + + + + + + + + + 0 + 0 + 0 + + + + + + + 53 + 132 + 228 + + + + + + + 146 + 195 + 255 + + + + + + + 99 + 163 + 241 + + + + + + + 26 + 66 + 114 + + + + + + + 35 + 88 + 152 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 53 + 132 + 228 + + + + + + + 0 + 0 + 0 + + + + + + + 154 + 193 + 241 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 0 + 0 + 0 + + + + + + + 53 + 132 + 228 + + + + + + + 146 + 195 + 255 + + + + + + + 99 + 163 + 241 + + + + + + + 26 + 66 + 114 + + + + + + + 35 + 88 + 152 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 53 + 132 + 228 + + + + + + + 0 + 0 + 0 + + + + + + + 154 + 193 + 241 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 26 + 66 + 114 + + + + + + + 53 + 132 + 228 + + + + + + + 146 + 195 + 255 + + + + + + + 99 + 163 + 241 + + + + + + + 26 + 66 + 114 + + + + + + + 35 + 88 + 152 + + + + + + + 26 + 66 + 114 + + + + + + + 255 + 255 + 255 + + + + + + + 26 + 66 + 114 + + + + + + + 53 + 132 + 228 + + + + + + + 53 + 132 + 228 + + + + + + + 0 + 0 + 0 + + + + + + + 53 + 132 + 228 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + All OFF + + + + + + + Ball + + + true + + + radio_buttons + + + + + + + Y10 + + + false + + + radio_buttons + + + + + + + + + + + + 0 + 0 + 0 + + + + + + + 53 + 132 + 228 + + + + + + + 146 + 195 + 255 + + + + + + + 99 + 163 + 241 + + + + + + + 26 + 66 + 114 + + + + + + + 35 + 88 + 152 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 53 + 132 + 228 + + + + + + + 0 + 0 + 0 + + + + + + + 154 + 193 + 241 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 0 + 0 + 0 + + + + + + + 53 + 132 + 228 + + + + + + + 146 + 195 + 255 + + + + + + + 99 + 163 + 241 + + + + + + + 26 + 66 + 114 + + + + + + + 35 + 88 + 152 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 53 + 132 + 228 + + + + + + + 0 + 0 + 0 + + + + + + + 154 + 193 + 241 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 26 + 66 + 114 + + + + + + + 53 + 132 + 228 + + + + + + + 146 + 195 + 255 + + + + + + + 99 + 163 + 241 + + + + + + + 26 + 66 + 114 + + + + + + + 35 + 88 + 152 + + + + + + + 26 + 66 + 114 + + + + + + + 255 + 255 + 255 + + + + + + + 26 + 66 + 114 + + + + + + + 53 + 132 + 228 + + + + + + + 53 + 132 + 228 + + + + + + + 0 + 0 + 0 + + + + + + + 53 + 132 + 228 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + All ON + + + + + + + Y2 + + + false + + + radio_buttons + + + + + + + Y6 + + + false + + + radio_buttons + + + + + + + B6 + + + radio_buttons + + + + + + + B4 + + + radio_buttons + + + + + + + B7 + + + radio_buttons + + + + + + + B3 + + + radio_buttons + + + + + + + Y8 + + + false + + + radio_buttons + + + + + + + B9 + + + radio_buttons + + + + + + + B8 + + + radio_buttons + + + + + + + + + + + + 0 + 0 + 0 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 239 + 161 + + + + + + + 250 + 225 + 103 + + + + + + + 123 + 105 + 22 + + + + + + + 164 + 141 + 30 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 246 + 211 + 45 + + + + + + + 0 + 0 + 0 + + + + + + + 250 + 233 + 150 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 0 + 0 + 0 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 239 + 161 + + + + + + + 250 + 225 + 103 + + + + + + + 123 + 105 + 22 + + + + + + + 164 + 141 + 30 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 246 + 211 + 45 + + + + + + + 0 + 0 + 0 + + + + + + + 250 + 233 + 150 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 123 + 105 + 22 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 239 + 161 + + + + + + + 250 + 225 + 103 + + + + + + + 123 + 105 + 22 + + + + + + + 164 + 141 + 30 + + + + + + + 123 + 105 + 22 + + + + + + + 255 + 255 + 255 + + + + + + + 123 + 105 + 22 + + + + + + + 246 + 211 + 45 + + + + + + + 246 + 211 + 45 + + + + + + + 0 + 0 + 0 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + All ON + + + + + + + B10 + + + radio_buttons + + + + + + + B1 + + + false + + + radio_buttons + + + + + + + Y0 + + + radio_buttons + + + + + + + Y5 + + + false + + + radio_buttons + + + + + + + Y7 + + + false + + + radio_buttons + + + + + + + NONE + + + false + + + radio_buttons + + + + + + + Y3 + + + false + + + radio_buttons + + + + + + + + + + + + 0 + 0 + 0 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 239 + 161 + + + + + + + 250 + 225 + 103 + + + + + + + 123 + 105 + 22 + + + + + + + 164 + 141 + 30 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 246 + 211 + 45 + + + + + + + 0 + 0 + 0 + + + + + + + 250 + 233 + 150 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 0 + 0 + 0 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 239 + 161 + + + + + + + 250 + 225 + 103 + + + + + + + 123 + 105 + 22 + + + + + + + 164 + 141 + 30 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 0 + 0 + 0 + + + + + + + 255 + 255 + 255 + + + + + + + 246 + 211 + 45 + + + + + + + 0 + 0 + 0 + + + + + + + 250 + 233 + 150 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + + 123 + 105 + 22 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 239 + 161 + + + + + + + 250 + 225 + 103 + + + + + + + 123 + 105 + 22 + + + + + + + 164 + 141 + 30 + + + + + + + 123 + 105 + 22 + + + + + + + 255 + 255 + 255 + + + + + + + 123 + 105 + 22 + + + + + + + 246 + 211 + 45 + + + + + + + 246 + 211 + 45 + + + + + + + 0 + 0 + 0 + + + + + + + 246 + 211 + 45 + + + + + + + 255 + 255 + 220 + + + + + + + 0 + 0 + 0 + + + + + + + 0 + 0 + 0 + + + + + + + + All OFF + + + + + + + Y4 + + + false + + + radio_buttons + + + + + + + B0 + + + false + + + radio_buttons + + + + + + + Y1 + + + false + + + radio_buttons + + + + + + + B5 + + + radio_buttons + + + + + + + B2 + + + radio_buttons + + + + + + + Y9 + + + false + + + radio_buttons + + + + - - - - NONE - - - false - - - radio_buttons - - + + + + + + + + + セッション挿入 + + + + diff --git a/consai_ros2/consai_visualizer/src/consai_visualizer/visualizer.py b/consai_ros2/consai_visualizer/src/consai_visualizer/visualizer.py index 54647caf1..1e19e8aa3 100644 --- a/consai_ros2/consai_visualizer/src/consai_visualizer/visualizer.py +++ b/consai_ros2/consai_visualizer/src/consai_visualizer/visualizer.py @@ -33,6 +33,7 @@ import rclpy from robocup_ssl_msgs.msg import BallReplacement, Replacement, RobotReplacement from rqt_py_common.ini_helper import pack, unpack +from std_msgs.msg import String class Visualizer(Plugin): @@ -126,6 +127,54 @@ def __init__(self, context): self.latest_battery_voltage = [0] * 16 + # self._widget.pushButton.clicked.connect(self.publish) + self._widget.session_injection_comboBox.addItem("HALT") + self._widget.session_injection_comboBox.addItem("STOP") + self._widget.session_injection_comboBox.addItem("OUR_KICKOFF_PREPARATION") + self._widget.session_injection_comboBox.addItem("OUR_KICKOFF_START") + self._widget.session_injection_comboBox.addItem("OUR_PENALTY_PREPARATION") + self._widget.session_injection_comboBox.addItem("OUR_PENALTY_START") + self._widget.session_injection_comboBox.addItem("OUR_DIRECT_FREE") + self._widget.session_injection_comboBox.addItem("OUR_BALL_PLACEMENT") + self._widget.session_injection_comboBox.addItem("THEIR_KICKOFF_PREPARATION") + self._widget.session_injection_comboBox.addItem("THEIR_KICKOFF_START") + self._widget.session_injection_comboBox.addItem("THEIR_PENALTY_PREPARATION") + self._widget.session_injection_comboBox.addItem("THEIR_PENALTY_START") + self._widget.session_injection_comboBox.addItem("THEIR_DIRECT_FREE") + self._widget.session_injection_comboBox.addItem("THEIR_BALL_PLACEMENT") + self._widget.session_injection_comboBox.addItem("INJECTION") + self._widget.session_injection_comboBox.addItem("INPLAY") + self._widget.session_injection_comboBox.addItem("OUR_INPLAY") + self._widget.session_injection_comboBox.addItem("THEIR_INPLAY") + self._widget.session_injection_comboBox.addItem("AMBIGUOUS_INPLAY") + self._widget.session_injection_comboBox.addItem( + "STOP_PRE_OUR_PENALTY_PREPARATION" + ) + self._widget.session_injection_comboBox.addItem( + "STOP_PRE_THEIR_PENALTY_PREPARATION" + ) + self._widget.session_injection_comboBox.addItem( + "STOP_PRE_OUR_KICKOFF_PREPARATION" + ) + self._widget.session_injection_comboBox.addItem( + "STOP_PRE_THEIR_KICKOFF_PREPARATION" + ) + self._widget.session_injection_comboBox.addItem("STOP_PRE_OUR_DIRECT_FREE") + self._widget.session_injection_comboBox.addItem("STOP_PRE_THEIR_DIRECT_FREE") + self._widget.session_injection_comboBox.addItem("STOP_PRE_FORCE_START") + self._widget.session_injection_pushButton.clicked.connect( + self._session_injection + ) + + self._pub_session_injection = self._node.create_publisher( + String, "/session_injection", 10 + ) + + def _session_injection(self): + msg = String() + msg.data = self._widget.session_injection_comboBox.currentText() + self._pub_session_injection.publish(msg) + def _callback_feedback(self, msg): for feedback in msg.feedback: try: