fixes
This commit is contained in:
@@ -71,15 +71,13 @@ class ArmControls
|
|||||||
|
|
||||||
this.frankaForceCommandedTopic = new ROSLIB.Topic({
|
this.frankaForceCommandedTopic = new ROSLIB.Topic({
|
||||||
ros : ros,
|
ros : ros,
|
||||||
name : '/'+this.namespace+'/robot_goal',
|
name : '/'+this.namespace+'/goal_wrench',
|
||||||
messageType : 'geometry_msgs/WrenchStamped',
|
messageType : 'geometry_msgs/WrenchStamped',
|
||||||
throttle_rate : 500 // 2Hz
|
throttle_rate : 500 // 2Hz
|
||||||
});
|
});
|
||||||
|
|
||||||
this.frankaForceCommandedTopic.subscribe(this.frankaForce.bind(this, 'commanded'));
|
this.frankaForceCommandedTopic.subscribe(this.frankaForce.bind(this, 'commanded'));
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
this.lastActiveButton = {
|
this.lastActiveButton = {
|
||||||
safetyMode : null,
|
safetyMode : null,
|
||||||
frankaMode : null,
|
frankaMode : null,
|
||||||
@@ -347,6 +345,26 @@ executingBagTopic.subscribe(function(message) {
|
|||||||
});
|
});
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
var bagNotifier = new ROSLIB.Topic({
|
||||||
|
ros : ros,
|
||||||
|
name : '/left/playback/status',
|
||||||
|
messageType : 'std_msgs/String'
|
||||||
|
});
|
||||||
|
|
||||||
|
|
||||||
|
bagNotifier.subscribe(function(message) {
|
||||||
|
console.log("bagNotifier: " +message.data)
|
||||||
|
if (message.data === "playing") {
|
||||||
|
|
||||||
|
} else if (message.data === "stopped")
|
||||||
|
{
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
});
|
||||||
|
|
||||||
|
|
||||||
// Last Bag
|
// Last Bag
|
||||||
var bagPlayingTopic = new ROSLIB.Topic({
|
var bagPlayingTopic = new ROSLIB.Topic({
|
||||||
ros : ros,
|
ros : ros,
|
||||||
@@ -364,6 +382,8 @@ bagPlayingTopic.subscribe(function(message) {
|
|||||||
|
|
||||||
function triggerService(serviceName, toSend, callback) {
|
function triggerService(serviceName, toSend, callback) {
|
||||||
|
|
||||||
|
disableUI();
|
||||||
|
|
||||||
var callback = callback || $.noop;
|
var callback = callback || $.noop;
|
||||||
|
|
||||||
if(!toSend) {
|
if(!toSend) {
|
||||||
@@ -423,8 +443,7 @@ function triggerService(serviceName, toSend, callback) {
|
|||||||
delay: 1000
|
delay: 1000
|
||||||
});
|
});
|
||||||
});
|
});
|
||||||
console.log("callback from callService in triggerService");
|
enableUI();
|
||||||
console.log(callback);
|
|
||||||
return callback(null, {success : true});
|
return callback(null, {success : true});
|
||||||
} else {
|
} else {
|
||||||
$(document).ready(function(){
|
$(document).ready(function(){
|
||||||
@@ -439,6 +458,7 @@ function triggerService(serviceName, toSend, callback) {
|
|||||||
delay: 1000
|
delay: 1000
|
||||||
});
|
});
|
||||||
});
|
});
|
||||||
|
enableUI();
|
||||||
return callback("Something went wrong :( " + serviceName, {success : false});
|
return callback("Something went wrong :( " + serviceName, {success : false});
|
||||||
}
|
}
|
||||||
}, function(error){
|
}, function(error){
|
||||||
@@ -455,6 +475,7 @@ function triggerService(serviceName, toSend, callback) {
|
|||||||
delay: 1000
|
delay: 1000
|
||||||
});
|
});
|
||||||
});
|
});
|
||||||
|
enableUI();
|
||||||
return callback("Something went wrong :( " + serviceName, {success : false})
|
return callback("Something went wrong :( " + serviceName, {success : false})
|
||||||
});
|
});
|
||||||
var responseCheckInterval = setInterval(function() {
|
var responseCheckInterval = setInterval(function() {
|
||||||
@@ -476,6 +497,7 @@ function triggerService(serviceName, toSend, callback) {
|
|||||||
});
|
});
|
||||||
});
|
});
|
||||||
clearInterval(responseCheckInterval);
|
clearInterval(responseCheckInterval);
|
||||||
|
enableUI();
|
||||||
return;
|
return;
|
||||||
}
|
}
|
||||||
}, 1000);
|
}, 1000);
|
||||||
@@ -512,8 +534,8 @@ function setEEFConfig(arm, config) {
|
|||||||
function startTeachRecoding() {
|
function startTeachRecoding() {
|
||||||
async.waterfall([
|
async.waterfall([
|
||||||
function(callback) {
|
function(callback) {
|
||||||
triggerService('/left/aescape/hardware/calibrateRobotiq', false, function(){
|
triggerService('/left/aescape/hardware/calibrateRobotiq', false, function(err, res){
|
||||||
callback();
|
callback(err, res);
|
||||||
});
|
});
|
||||||
},
|
},
|
||||||
function(response, callback) {
|
function(response, callback) {
|
||||||
@@ -523,25 +545,23 @@ function startTeachRecoding() {
|
|||||||
triggerService('/aescape/bags/startTeachRecording', false, callback)
|
triggerService('/aescape/bags/startTeachRecording', false, callback)
|
||||||
}
|
}
|
||||||
], function (err, result) {
|
], function (err, result) {
|
||||||
|
console.log("starting teach recoding");
|
||||||
});
|
});
|
||||||
}
|
}
|
||||||
|
|
||||||
function stopTeachRecording() {
|
function stopTeachRecording() {
|
||||||
async.waterfall([
|
async.waterfall([
|
||||||
function(callback) {
|
function(callback) {
|
||||||
console.log("function 1");
|
|
||||||
triggerService('/aescape/bags/stopTeachRecording', false, callback);
|
triggerService('/aescape/bags/stopTeachRecording', false, callback);
|
||||||
},
|
},
|
||||||
function(response, callback) {
|
function(response, callback) {
|
||||||
console.log("function 2");
|
|
||||||
triggerService('/left/aescape/mode/activateReadyController', false, callback);
|
triggerService('/left/aescape/mode/activateReadyController', false, callback);
|
||||||
},
|
},
|
||||||
function(response, callback) {
|
function(response, callback) {
|
||||||
console.log("function 3");
|
setTimeout(function(){
|
||||||
console.log(callback)
|
|
||||||
displayTaggingOptions('teach');
|
displayTaggingOptions('teach');
|
||||||
callback();
|
callback();
|
||||||
|
}, 2000)
|
||||||
}
|
}
|
||||||
], function (err, result) {
|
], function (err, result) {
|
||||||
console.log(err);
|
console.log(err);
|
||||||
@@ -571,8 +591,11 @@ function stopPlayingRecording() {
|
|||||||
triggerService('/left/aescape/mode/activateReadyController', false, callback);
|
triggerService('/left/aescape/mode/activateReadyController', false, callback);
|
||||||
},
|
},
|
||||||
function(response, callback) {
|
function(response, callback) {
|
||||||
|
setTimeout(function(){
|
||||||
displayTaggingOptions('play');
|
displayTaggingOptions('play');
|
||||||
callback();
|
callback();
|
||||||
|
}, 2000)
|
||||||
|
|
||||||
}
|
}
|
||||||
], function (err, result) {
|
], function (err, result) {
|
||||||
// result now equals 'done'
|
// result now equals 'done'
|
||||||
|
|||||||
@@ -9,9 +9,15 @@ function getBagList(callback)
|
|||||||
serviceType : 'demobot/TriggerList'
|
serviceType : 'demobot/TriggerList'
|
||||||
});
|
});
|
||||||
|
|
||||||
var request = new ROSLIB.ServiceRequest({});
|
toSend = {
|
||||||
|
message : String(Math.random())
|
||||||
|
}
|
||||||
|
|
||||||
|
var request = new ROSLIB.ServiceRequest(toSend);
|
||||||
|
|
||||||
service.callService(request, function(result) {
|
service.callService(request, function(result) {
|
||||||
|
console.log("result from getBagList");
|
||||||
|
console.log(result.message);
|
||||||
callback(JSON.parse(result.message));
|
callback(JSON.parse(result.message));
|
||||||
});
|
});
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -183,66 +183,6 @@ ros.on('close', function() {
|
|||||||
//ros.connect(ros.connectionName);
|
//ros.connect(ros.connectionName);
|
||||||
|
|
||||||
|
|
||||||
///////////////////////////////////////////////////////////////////////////////////
|
|
||||||
// Publishers
|
|
||||||
///////////////////////////////////////////////////////////////////////////////////
|
|
||||||
|
|
||||||
function publishBagMessage(bagFilename)
|
|
||||||
{
|
|
||||||
var bag_file_message = ""
|
|
||||||
bag_file_message += bagFilename;
|
|
||||||
if (bagFilename != "STOP")
|
|
||||||
{
|
|
||||||
for (topic in ros.topics)
|
|
||||||
{
|
|
||||||
if(ros.topics[topic].bag)
|
|
||||||
{
|
|
||||||
bag_file_message += " " + ros.topics[topic].name
|
|
||||||
}
|
|
||||||
}
|
|
||||||
}
|
|
||||||
var bagMessage = new ROSLIB.Message({
|
|
||||||
data : bagFilename
|
|
||||||
})
|
|
||||||
bagPublisher.publish(bagMessage)
|
|
||||||
}
|
|
||||||
|
|
||||||
////////////////////////////////////////////////////////////////
|
|
||||||
// Topics
|
|
||||||
////////////////////////////////////////////////////////////////
|
|
||||||
|
|
||||||
var bagPublisher = new ROSLIB.Topic({
|
|
||||||
ros : ros,
|
|
||||||
name : 'bag_publisher',
|
|
||||||
messageType : 'std_msgs/String'
|
|
||||||
});
|
|
||||||
|
|
||||||
var bagNotifier = new ROSLIB.Topic({
|
|
||||||
ros : ros,
|
|
||||||
name : 'bag_notifier',
|
|
||||||
messageType : 'std_msgs/String'
|
|
||||||
});
|
|
||||||
|
|
||||||
////////////////////////////////////////////////////////////////
|
|
||||||
// Subscribers
|
|
||||||
////////////////////////////////////////////////////////////////
|
|
||||||
|
|
||||||
|
|
||||||
bagNotifier.subscribe(function(message) {
|
|
||||||
if (message.data === "STARTED") {
|
|
||||||
document.getElementById("recordButtonText").innerHTML = "Stop"
|
|
||||||
document.getElementById("recordButton").className = "btn btn-danger"
|
|
||||||
} else if (message.data === "STOPPED")
|
|
||||||
{
|
|
||||||
document.getElementById("recordButtonText").innerHTML = "Start"
|
|
||||||
document.getElementById("recordButton").className = "btn btn-primary"
|
|
||||||
}
|
|
||||||
|
|
||||||
console.log("bagNotifier: " +message.data)
|
|
||||||
});
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
///////////////////////////////////////////////////////////////////////////////////
|
///////////////////////////////////////////////////////////////////////////////////
|
||||||
// Functions
|
// Functions
|
||||||
///////////////////////////////////////////////////////////////////////////////////
|
///////////////////////////////////////////////////////////////////////////////////
|
||||||
|
|||||||
Reference in New Issue
Block a user