Trying to access joint value from class

asked 2021-08-11 12:43:04 -0600

PGTKing gravatar image

Hey guys I am trying to get access to the joint value from my class that I setup but it has been pain to extract and don't know how to. here is my code

class Robotreacher:
def __init__(self):
    rospy.init_node('robot_control_node', anonymous=True)
    self.talker = rospy.Publisher('/rrbot/joint1_position_controller/command', Float64, queue_size=10)
    rospy.Subscriber('/rrbot/joint_states', JointState, self.joint_callback)
    self.force = None
    self.joint1 = 0
    self.target1 = random.randint(10, 62)/10
    self.start_time = time.time()
    self.rate = rospy.Rate(1)
    self.reward = None
    print("the target is", self.target1)
    print("the reward is", self.reward)



    while self.observation_check() is False:
        self.give_force()
        self.rate.sleep()


def give_force(self):
    self.force =  random.randrange(-8, 8, 1)  # Changes force every time, right before publishing
    self.talker.publish(self.force)
    #print("the force is ", self.force)
    return self.force            

def joint_callback(self, data):
    #print(data)
    self.joint1 = abs(data.position[0])%(2*math.pi)


def observation_check(self):
    target2 = self.target1 - 0.2
    if target2 < self.joint1 < self.target1:
        done = True
    else:
        done = False
    return done

def what_is_reward(self):
    #reward = None
    if self.observation_check() is True:
        self.reward = (time.time() - self.start_time)

    return self.reward
    print("the reward is", self.reward)

def get_joint(self):
    return self.joint1

def robotcontrolloop2(): i=0 training_samplex = [] r = Robotreacher() #w = r.give_force() #print("this is force", w) training_z = []

while i < 5:
    z = r.give_force()
    p = r.get_joint
    print("this joint position is", p)
    i += 1
    #training_z.append(z)
#print(training_z)

robotcontrolloop2()

edit retag flag offensive close merge delete