Skip to content

Commit

Permalink
[jsk_fetch_startup] Do not use ConnectionBasedTransport in correct_po…
Browse files Browse the repository at this point in the history
…sition.py
  • Loading branch information
708yamaguchi authored and knorth55 committed Jun 3, 2022
1 parent a2eb52c commit c5bd90e
Showing 1 changed file with 6 additions and 13 deletions.
19 changes: 6 additions & 13 deletions jsk_fetch_robot/jsk_fetch_startup/scripts/correct_position.py
Original file line number Diff line number Diff line change
Expand Up @@ -2,20 +2,20 @@

import rospy

from jsk_topic_tools import ConnectionBasedTransport
from power_msgs.msg import BatteryState
from geometry_msgs.msg import PoseWithCovarianceStamped
from geometry_msgs.msg import Pose
from visualization_msgs.msg import MarkerArray


class CorrectPosition(ConnectionBasedTransport):
class CorrectPosition():

def __init__(self):
super(CorrectPosition, self).__init__()
self.pub = self.advertise('initialpose',
PoseWithCovarianceStamped,
queue_size=1)
self.sub_dock = rospy.Subscriber(
'/battery_state', BatteryState, self._cb)
self.pub = rospy.Publisher('initialpose',
PoseWithCovarianceStamped,
queue_size=1)
self.dock_pose = Pose()
robot_name = rospy.get_param('/robot/name')
if robot_name == 'fetch15':
Expand All @@ -30,13 +30,6 @@ def __init__(self):
self.is_docking = False
self.timer = rospy.Timer(rospy.Duration(1.0), self._cb_correct_position)

def subscribe(self):
self.sub_dock = rospy.Subscriber(
'/battery_state', BatteryState, self._cb)

def unsubscribe(self):
self.sub_dock.unregister()

def _cb(self, msg):
self.is_docking = msg.is_charging

Expand Down

0 comments on commit c5bd90e

Please sign in to comment.