Loading files
a37771a92This file is pinned to the selected release. Download the original to open it in your design tool.
<template>
<div class="wrap">
<h3> Arm controls </h3>
<div class="controls">
<Checkbox ref="open-loop" v-bind:name="'Open Loop'" v-on:toggle="updateControlMode('open-loop', $event)"/>
<Checkbox ref="closed-loop" v-bind:name="'Closed Loop'" v-on:toggle="updateControlMode('closed-loop', $event)"/>
</div>
<div class="joint-b-calibration" v-if='!this.jointBIsCalibrated && this.controlMode !== "calibrating"'>
Joint B not calibrated!
<button v-on:click="startCalibration()">Calibrate</button>
</div>
<div class="joint-b-calibration" v-if='!this.jointBIsCalibrated && this.controlMode === "calibrating"'>
Calibrating Joint B...
<button v-on:click="abortCalibration()">Abort</button>
</div>
</div>
</template>
<script>
import EncoderCounts from './EncoderCounts.vue'
import Checkbox from './Checkbox.vue'
import { mapGetters, mapMutations } from 'vuex'
let interval;
export default {
data() {
return {
xboxControlEpsilon: 0.4,
stateInput: {
state: "off"
},
jointBIsCalibrated: false,
calibrationTimer: -1
}
},
computed: {
...mapGetters('controls', {
controlMode: 'controlMode'
}),
},
beforeDestroy: function () {
window.clearInterval(interval)
},
created: function () {
// Subscribe to requests to change state from IK backend
this.$parent.subscribe('/arm_control_state', (msg) => {
console.log('received new state: ' + msg.state)
var new_state = msg.state
// If new state matches current state
if (new_state === this.controlMode) {
return
}
// If new state is not current state, turn off current state
if (this.controlMode === 'closed-loop' || this.controlMode === 'open-loop') {
this.$refs[this.controlMode].toggle()
}
if (new_state === 'closed-loop' || new_state === 'open-loop') {
this.$refs[new_state].toggle()
}
this.setControlMode(new_state)
})
this.$parent.subscribe('/ik_reset', (msg) => {
const armStateMsg = {
'type': 'ArmControlState',
'state': this.controlMode
}
this.$parent.publish('/arm_control_state', armStateMsg)
})
this.$parent.subscribe('/ra_b_calib_data', (msg) => {
this.updateCalibrationStatus(msg)
})
this.$parent.subscribe('/sa_b_calib_data', (msg) => {
this.updateCalibrationStatus(msg)
})
this.$parent.subscribe('/ik_reset', (msg) => {
const armStateMsg = {
'type': 'ArmControlState',
'state': this.controlMode
}
this.$parent.publish('/arm_control_state', armStateMsg)
})
const XBOX_CONFIG = {
'left_js_x': 0,
'left_js_y': 1,
'left_trigger': 6,
'right_trigger': 7,
'right_js_x': 2,
'right_js_y': 3,
'right_bumper': 5,
'left_bumper': 4,
'd_pad_up': 12,
'd_pad_down': 13,
'd_pad_right': 14,
'd_pad_left': 15,
'a': 0,
'b': 1,
'x': 2,
'y': 3
}
const updateRate = 0.1
interval = window.setInterval(() => {
const gamepads = navigator.getGamepads()
for (let i = 0; i < 4; i++) {
const gamepad = gamepads[i]
if (gamepad) {
if (gamepad.id.includes('Microsoft') || gamepad.id.includes('Xbox')) {
const xboxData = {
'type': 'Xbox',
'left_js_x': gamepad.axes[XBOX_CONFIG['left_js_x']], // shoulder rotate
'left_js_y': gamepad.axes[XBOX_CONFIG['left_js_y']], // shoulder tilt
'left_trigger': gamepad.buttons[XBOX_CONFIG['left_trigger']]['value'], // elbow forward
'right_trigger': gamepad.buttons[XBOX_CONFIG['right_trigger']]['value'], // elbow back
'right_js_x': gamepad.axes[XBOX_CONFIG['right_js_x']], // hand rotate
'right_js_y': gamepad.axes[XBOX_CONFIG['right_js_y']], // hand tilt
'right_bumper': gamepad.buttons[XBOX_CONFIG['right_bumper']]['pressed'], // grip close
'left_bumper': gamepad.buttons[XBOX_CONFIG['left_bumper']]['pressed'], // grip open
'd_pad_up': gamepad.buttons[XBOX_CONFIG['d_pad_up']]['pressed'],
'd_pad_down': gamepad.buttons[XBOX_CONFIG['d_pad_down']]['pressed'],
'd_pad_right': gamepad.buttons[XBOX_CONFIG['d_pad_right']]['pressed'],
'd_pad_left': gamepad.buttons[XBOX_CONFIG['d_pad_left']]['pressed'],
'a': gamepad.buttons[XBOX_CONFIG['a']]['pressed'],
'b': gamepad.buttons[XBOX_CONFIG['b']]['pressed'],
'x': gamepad.buttons[XBOX_CONFIG['x']]['pressed'],
'y': gamepad.buttons[XBOX_CONFIG['y']]['pressed']
}
if (this.controlMode !== 'open-loop' && this.checkXboxInput(xboxData)) {
console.log('forcing open loop')
this.forceOpenLoop()
}
if (this.controlMode === 'open-loop') {
this.$parent.publish('/ra_control', xboxData)
}
}
}
}
}, updateRate*1000)
},
methods: {
updateControlMode: function (mode, checked) {
console.log("updating control mode")
if (checked) {
// control mode can either be open loop or control mode, not both
if (this.controlMode === 'closed-loop' || this.controlMode === 'open-loop') {
this.$refs[this.controlMode].toggle()
}
this.setControlMode(mode)
}
else {
this.setControlMode('off')
}
const armStateMsg = {
'type': 'ArmControlState',
'state': this.controlMode
}
this.$parent.publish('/arm_control_state', armStateMsg)
},
forceOpenLoop: function () {
if (this.controlMode === 'open-loop') {
return
}
if (this.controlMode === 'closed-loop') {
this.$refs['closed-loop'].toggle()
}
this.$refs['open-loop'].toggle()
this.setControlMode('open-loop')
const armStateMsg = {
'type': 'ArmControlState',
'state': this.controlMode
}
this.$parent.publish('/arm_control_state', armStateMsg)
},
checkXboxInput: function (xboxData) {
if (Math.abs(xboxData['left_js_x']) > this.xboxControlEpsilon) {
return true
}
if (Math.abs(xboxData['left_js_y']) > this.xboxControlEpsilon) {
return true
}
if (Math.abs(xboxData['left_trigger']) > this.xboxControlEpsilon) {
return true
}
if (Math.abs(xboxData['right_trigger']) > this.xboxControlEpsilon) {
return true
}
if (Math.abs(xboxData['right_js_x']) > this.xboxControlEpsilon) {
return true
}
if (Math.abs(xboxData['right_js_y']) > this.xboxControlEpsilon) {
return true
}
if (xboxData['left_bumper']) {
return true
}
if (xboxData['right_bumper']) {
return true
}
if (xboxData['a']) {
return true
}
if (xboxData['b']) {
return true
}
if (xboxData['x']) {
return true
}
if (xboxData['y']) {
return true
}
if (xboxData['d_pad_up']) {
return true
}
if (xboxData['d_pad_down']) {
return true
}
if (xboxData['d_pad_left']) {
return true
}
if (xboxData['d_pad_right']) {
return true
}
return false
},
updateCalibrationStatus: function(msg) {
if (msg.calibrated && !this.jointBIsCalibrated) {
clearTimeout(this.calibrationTimer)
const armStateMsg = {
'type': 'ArmControlState',
'state': 'off'
}
this.$parent.publish('/arm_control_state', armStateMsg)
}
this.jointBIsCalibrated = msg.calibrated
},
startCalibration: function() {
const armStateMsg = {
'type': 'ArmControlState',
'state': 'calibrating'
}
this.$parent.publish('/arm_control_state', armStateMsg)
this.calibrationTimer = setTimeout(() => {
this.abortCalibration()
}, 20000)
},
abortCalibration: function() {
clearTimeout(this.calibrationTimer)
const armStateMsg = {
'type': 'ArmControlState',
'state': 'off'
}
this.$parent.publish('/arm_control_state', armStateMsg)
},
...mapMutations('controls', {
setControlMode: 'setControlMode'
})
},
components: {
EncoderCounts,
Checkbox
}
}
</script>
<style scoped>
.wrap {
display: inline-block;
align-items: center;
justify-items: center;
width: 100%;
}
.controls {
display: flex;
align-items:center;
}
.header {
display:flex;
align-items:center;
}
.joint-b-calibration {
display: flex;
gap: 10px;
width: 250px;
font-weight: bold;
color: red;
}
</style>