Changing print statements to rospy.login(), removed print statements for testing purposes, cleaned up code a little bit.