mirror of
https://github.com/iNavFlight/inav-configurator.git
synced 2025-07-17 05:15:20 +03:00
742 lines
25 KiB
JavaScript
742 lines
25 KiB
JavaScript
'use strict';
|
|
/*global chrome,GUI,BOARD_ALIGNMENT,TABS,nwdialog,helper,$*/
|
|
|
|
TABS.magnetometer = {};
|
|
|
|
|
|
TABS.magnetometer.initialize = function (callback) {
|
|
var self = this;
|
|
|
|
if (GUI.active_tab != 'magnetometer') {
|
|
GUI.active_tab = 'magnetometer';
|
|
googleAnalytics.sendAppView('MAGNETOMETER');
|
|
}
|
|
|
|
self.alignmentConfig = {
|
|
pitch: 0,
|
|
roll: 0,
|
|
yaw: 0
|
|
};
|
|
|
|
self.boardAlignmentConfig = {
|
|
pitch: 0,
|
|
roll: 0,
|
|
yaw: 0
|
|
};
|
|
|
|
self.pageElements = {};
|
|
self.isSavePreset = true;
|
|
self.showMagnetometer = true;
|
|
//========================
|
|
// Load chain
|
|
// =======================
|
|
var loadChainer = new MSPChainerClass();
|
|
|
|
var loadChain = [
|
|
mspHelper.loadMixerConfig,
|
|
mspHelper.loadBoardAlignment,
|
|
function (callback) {
|
|
self.boardAlignmentConfig.pitch = Math.round(BOARD_ALIGNMENT.pitch / 10);
|
|
self.boardAlignmentConfig.roll = Math.round(BOARD_ALIGNMENT.roll / 10);
|
|
self.boardAlignmentConfig.yaw = Math.round(BOARD_ALIGNMENT.yaw / 10);
|
|
callback();
|
|
},
|
|
mspHelper.loadSensorAlignment,
|
|
// Pitch and roll must be inverted
|
|
function (callback) {
|
|
mspHelper.getSetting("align_mag_roll").then(function (data) {
|
|
self.alignmentConfig.roll = parseInt(data.value, 10) / 10;
|
|
}).then(callback)
|
|
},
|
|
function (callback) {
|
|
mspHelper.getSetting("align_mag_pitch").then(function (data) {
|
|
self.alignmentConfig.pitch = parseInt(data.value, 10) / 10;
|
|
}).then(callback)
|
|
},
|
|
function (callback) {
|
|
mspHelper.getSetting("align_mag_yaw").then(function (data) {
|
|
self.alignmentConfig.yaw = parseInt(data.value, 10) / 10;
|
|
}).then(callback)
|
|
}
|
|
];
|
|
|
|
loadChainer.setChain(loadChain);
|
|
loadChainer.setExitPoint(load_html);
|
|
loadChainer.execute();
|
|
|
|
function areAnglesZero() {
|
|
return self.alignmentConfig.pitch === 0 && self.alignmentConfig.roll === 0 && self.alignmentConfig.yaw === 0
|
|
}
|
|
|
|
function isBoardAlignmentZero() {
|
|
return (self.boardAlignmentConfig.pitch == 0 ) && (self.boardAlignmentConfig.roll == 0 ) && (self.boardAlignmentConfig.yaw == 0);
|
|
}
|
|
|
|
//========================
|
|
// Save chain
|
|
// =======================
|
|
var saveChainer = new MSPChainerClass();
|
|
|
|
var saveChain = [
|
|
function (callback) {
|
|
BOARD_ALIGNMENT.pitch = self.boardAlignmentConfig.pitch * 10;
|
|
BOARD_ALIGNMENT.roll = self.boardAlignmentConfig.roll * 10;
|
|
BOARD_ALIGNMENT.yaw = self.boardAlignmentConfig.yaw * 10;
|
|
callback();
|
|
},
|
|
mspHelper.saveBoardAlignment,
|
|
// Magnetometer alignment
|
|
function (callback) {
|
|
let orientation_mag_e = $('select.magalign');
|
|
SENSOR_ALIGNMENT.align_mag = parseInt(orientation_mag_e.val());
|
|
callback();
|
|
},
|
|
mspHelper.saveSensorAlignment,
|
|
// Pitch/Roll/Yaw
|
|
// Pitch and roll must be inverted - ???
|
|
function (callback) {
|
|
if (self.isSavePreset)
|
|
mspHelper.setSetting("align_mag_roll", 0, callback);
|
|
else
|
|
mspHelper.setSetting("align_mag_roll", self.alignmentConfig.roll * 10, callback);
|
|
},
|
|
function (callback) {
|
|
if (self.isSavePreset)
|
|
mspHelper.setSetting("align_mag_pitch", 0, callback);
|
|
else
|
|
mspHelper.setSetting("align_mag_pitch", self.alignmentConfig.pitch * 10, callback);
|
|
|
|
},
|
|
function (callback) {
|
|
if (self.isSavePreset)
|
|
mspHelper.setSetting("align_mag_yaw", 0, callback);
|
|
else {
|
|
var fix = 0;
|
|
if ( areAnglesZero() ) {
|
|
fix = 1; //if all angles are 0, then we have to save yaw = 1 (0.1 deg) to enforce usage of angles, not a usage of preset
|
|
}
|
|
mspHelper.setSetting("align_mag_yaw", self.alignmentConfig.yaw * 10 + fix, callback);
|
|
}
|
|
},
|
|
mspHelper.saveToEeprom
|
|
];
|
|
|
|
saveChainer.setChain(saveChain);
|
|
saveChainer.setExitPoint(reboot);
|
|
|
|
function reboot() {
|
|
//noinspection JSUnresolvedVariable
|
|
GUI.log(chrome.i18n.getMessage('configurationEepromSaved'));
|
|
|
|
GUI.tab_switch_cleanup(function () {
|
|
MSP.send_message(MSPCodes.MSP_SET_REBOOT, false, false, reinitialize);
|
|
});
|
|
}
|
|
|
|
function reinitialize() {
|
|
GUI.log(chrome.i18n.getMessage('deviceRebooting'));
|
|
GUI.handleReconnect($('.tab_magnetometer a'));
|
|
}
|
|
|
|
function load_html() {
|
|
GUI.load("./tabs/magnetometer.html", process_html);
|
|
}
|
|
|
|
function generateRange(min, max, step) {
|
|
const arr = [];
|
|
for (var i = min; i <= max; i += step) {
|
|
arr.push(i)
|
|
}
|
|
return arr;
|
|
}
|
|
|
|
function toUpperRange(input, max) {
|
|
while (input > max) input -= 360;
|
|
while (input + 360 <= max) input += 360;
|
|
return input;
|
|
}
|
|
|
|
/*
|
|
Returns pitch, roll and yaw in degree by the id of a preset.
|
|
Degree are the ones used in the slider
|
|
*/
|
|
function getAxisDegreeWithPreset(selectedPreset) {
|
|
//pitch, roll, yaw
|
|
switch (selectedPreset) {
|
|
case 1: //CW0_DEG = 1
|
|
return [0, 0, 0];
|
|
case 2: //CW90_DEG = 2
|
|
return [0, 0, 90];
|
|
case 3: //CW180_DEG = 3
|
|
return [0, 0, 180];
|
|
case 4: //CW270_DEG = 4
|
|
return [0, 0, 270];
|
|
case 5: //CW0_DEG_FLIP = 5
|
|
return [180, 0, 0];
|
|
case 6: //CW90_DEG_FLIP = 5
|
|
return [180, 0, 90];
|
|
case 7: //CW180_DEG_FLIP = 5
|
|
return [180, 0, 180];
|
|
case 0: //ALIGN_DEFAULT = 0
|
|
case 8: //CW270_DEG_FLIP = 5
|
|
default://If not recognized, returns defualt
|
|
return [180, 0, 270];
|
|
}
|
|
}
|
|
|
|
function getAxisDegreeWithPresetAndBoardOrientation(selectedPreset) {
|
|
var degree = getAxisDegreeWithPreset(selectedPreset);
|
|
|
|
if (isBoardAlignmentZero()) {
|
|
return degree;
|
|
}
|
|
|
|
//degree[0] - pitch
|
|
//degree[1] - roll
|
|
//degree[2] - yaw
|
|
//-(pitch-180), -180 - yaw, roll
|
|
var magRotation = new THREE.Euler(-THREE.Math.degToRad(degree[0]-180), THREE.Math.degToRad(-180 - degree[2]), THREE.Math.degToRad(degree[1]), 'YXZ');
|
|
var matrix = (new THREE.Matrix4()).makeRotationFromEuler(magRotation);
|
|
|
|
var boardRotation = new THREE.Euler( THREE.Math.degToRad( self.boardAlignmentConfig.pitch ), THREE.Math.degToRad( -self.boardAlignmentConfig.yaw ), THREE.Math.degToRad( self.boardAlignmentConfig.roll ), 'YXZ');
|
|
var matrix1 = (new THREE.Matrix4()).makeRotationFromEuler(boardRotation);
|
|
|
|
matrix.premultiply(matrix1);
|
|
|
|
var euler = new THREE.Euler();
|
|
euler.setFromRotationMatrix(matrix, 'YXZ');
|
|
|
|
var pitch = toUpperRange( Math.round( THREE.Math.radToDeg(-euler.x)) + 180, 180 );
|
|
var yaw = toUpperRange( Math.round( -180 - THREE.Math.radToDeg(euler.y)), 359 );
|
|
var roll = toUpperRange( Math.round( THREE.Math.radToDeg(euler.z)), 180 );
|
|
|
|
return [pitch, roll, yaw];
|
|
}
|
|
|
|
function updateMagOrientationWithPreset() {
|
|
if (self.isSavePreset) {
|
|
const degrees = getAxisDegreeWithPresetAndBoardOrientation(SENSOR_ALIGNMENT.align_mag);
|
|
presetUpdated(degrees);
|
|
}
|
|
}
|
|
|
|
function updateBoardRollAxis(value) {
|
|
self.boardAlignmentConfig.roll = Number(value);
|
|
self.pageElements.board_roll_slider.val(self.boardAlignmentConfig.roll);
|
|
self.pageElements.orientation_board_roll.val(self.boardAlignmentConfig.roll);
|
|
updateMagOrientationWithPreset();
|
|
self.render3D();
|
|
}
|
|
|
|
function updateBoardPitchAxis(value) {
|
|
self.boardAlignmentConfig.pitch = Number(value);
|
|
self.pageElements.board_pitch_slider.val(self.boardAlignmentConfig.pitch);
|
|
self.pageElements.orientation_board_pitch.val(self.boardAlignmentConfig.pitch);
|
|
updateMagOrientationWithPreset();
|
|
self.render3D();
|
|
}
|
|
|
|
function updateBoardYawAxis(value) {
|
|
self.boardAlignmentConfig.yaw = Number(value);
|
|
self.pageElements.board_yaw_slider.val(self.boardAlignmentConfig.yaw);
|
|
self.pageElements.orientation_board_yaw.val(self.boardAlignmentConfig.yaw);
|
|
updateMagOrientationWithPreset();
|
|
self.render3D();
|
|
}
|
|
|
|
//Called when roll values change
|
|
function updateRollAxis(value) {
|
|
self.alignmentConfig.roll = Number(value);
|
|
self.pageElements.roll_slider.val(self.alignmentConfig.roll);
|
|
self.pageElements.orientation_mag_roll.val(self.alignmentConfig.roll);
|
|
self.render3D();
|
|
}
|
|
|
|
//Called when pitch values change
|
|
function updatePitchAxis(value) {
|
|
self.alignmentConfig.pitch = Number(value);
|
|
self.pageElements.pitch_slider.val(self.alignmentConfig.pitch);
|
|
self.pageElements.orientation_mag_pitch.val(self.alignmentConfig.pitch);
|
|
self.render3D();
|
|
}
|
|
|
|
//Called when yaw values change
|
|
function updateYawAxis(value) {
|
|
self.alignmentConfig.yaw = Number(value);
|
|
self.pageElements.yaw_slider.val(self.alignmentConfig.yaw);
|
|
self.pageElements.orientation_mag_yaw.val(self.alignmentConfig.yaw);
|
|
self.render3D();
|
|
}
|
|
|
|
function enableSavePreset() {
|
|
self.isSavePreset = true;
|
|
self.pageElements.orientation_mag_e.css("opacity", 1);
|
|
self.pageElements.orientation_mag_e.css("text-decoration", "");
|
|
}
|
|
|
|
function disableSavePreset() {
|
|
self.isSavePreset = false;
|
|
self.pageElements.orientation_mag_e.css("opacity", 0.5);
|
|
self.pageElements.orientation_mag_e.css("text-decoration", "line-through");
|
|
}
|
|
|
|
|
|
//Called when a preset is selected
|
|
function presetUpdated(degrees) {
|
|
enableSavePreset();
|
|
updatePitchAxis(degrees[0]);
|
|
updateRollAxis(degrees[1]);
|
|
updateYawAxis(degrees[2]);
|
|
}
|
|
|
|
|
|
function process_html() {
|
|
|
|
localize();
|
|
|
|
// initialize 3D
|
|
self.initialize3D();
|
|
|
|
let alignments = FC.getSensorAlignments();
|
|
|
|
self.pageElements.orientation_board_roll = $('#boardAlignRoll');
|
|
self.pageElements.orientation_board_pitch = $('#boardAlignPitch');
|
|
self.pageElements.orientation_board_yaw = $('#boardAlignYaw');
|
|
self.pageElements.board_roll_slider = $('#board_roll_slider');
|
|
self.pageElements.board_pitch_slider = $('#board_pitch_slider');
|
|
self.pageElements.board_yaw_slider = $('#board_yaw_slider');
|
|
|
|
self.pageElements.orientation_mag_e = $('select.magalign');
|
|
self.pageElements.orientation_mag_roll = $('#alignRoll');
|
|
self.pageElements.orientation_mag_pitch = $('#alignPitch');
|
|
self.pageElements.orientation_mag_yaw = $('#alignYaw');
|
|
self.pageElements.roll_slider = $('#roll_slider');
|
|
self.pageElements.pitch_slider = $('#pitch_slider');
|
|
self.pageElements.yaw_slider = $('#yaw_slider');
|
|
|
|
self.roll_e = $('dd.roll'),
|
|
self.pitch_e = $('dd.pitch'),
|
|
self.heading_e = $('dd.heading');
|
|
|
|
for (i = 0; i < alignments.length; i++) {
|
|
self.pageElements.orientation_mag_e.append('<option value="' + (i + 1) + '">' + alignments[i] + '</option>');
|
|
}
|
|
self.pageElements.orientation_mag_e.val(SENSOR_ALIGNMENT.align_mag);
|
|
|
|
if (areAnglesZero()) {
|
|
//If using a preset, checking if custom values are equal to 0
|
|
//Update the slider, but don't save the value until they will be not modified.
|
|
const degrees = getAxisDegreeWithPresetAndBoardOrientation(SENSOR_ALIGNMENT.align_mag);
|
|
presetUpdated(degrees);
|
|
}
|
|
else {
|
|
updateRollAxis(self.alignmentConfig.roll);
|
|
updatePitchAxis(self.alignmentConfig.pitch);
|
|
updateYawAxis(self.alignmentConfig.yaw);
|
|
disableSavePreset();
|
|
}
|
|
|
|
|
|
self.pageElements.orientation_board_roll.change(function () {
|
|
updateBoardRollAxis(clamp(this, -180, 360));
|
|
});
|
|
|
|
self.pageElements.orientation_board_pitch.change(function () {
|
|
updateBoardPitchAxis(clamp(this, -180, 360));
|
|
});
|
|
|
|
self.pageElements.orientation_board_yaw.change(function () {
|
|
updateBoardYawAxis(clamp(this, -180, 360));
|
|
});
|
|
|
|
self.pageElements.board_roll_slider.noUiSlider({
|
|
start: [self.boardAlignmentConfig.roll],
|
|
range: {
|
|
'min': [-180],
|
|
'max': [360]
|
|
},
|
|
step: 1,
|
|
});
|
|
self.pageElements.board_roll_slider.noUiSlider_pips({
|
|
mode: 'values',
|
|
values: generateRange(-180, 360, 45),
|
|
density: 4,
|
|
stepped: true
|
|
});
|
|
|
|
self.pageElements.board_pitch_slider.noUiSlider({
|
|
start: [self.boardAlignmentConfig.pitch],
|
|
range: {
|
|
'min': [-180],
|
|
'max': [360]
|
|
},
|
|
step: 1,
|
|
});
|
|
self.pageElements.board_pitch_slider.noUiSlider_pips({
|
|
mode: 'values',
|
|
values: generateRange(-180, 360, 45),
|
|
density: 4,
|
|
stepped: true
|
|
});
|
|
|
|
self.pageElements.board_yaw_slider.noUiSlider({
|
|
start: [self.boardAlignmentConfig.yaw],
|
|
range: {
|
|
'min': [-180],
|
|
'max': [360]
|
|
},
|
|
step: 1,
|
|
});
|
|
self.pageElements.board_yaw_slider.noUiSlider_pips({
|
|
mode: 'values',
|
|
values: generateRange(-180, 360, 45),
|
|
density: 4,
|
|
stepped: true
|
|
});
|
|
|
|
|
|
self.pageElements.board_pitch_slider.Link('lower').to((e) => {
|
|
updateBoardPitchAxis(e);
|
|
});
|
|
self.pageElements.board_roll_slider.Link('lower').to((e) => {
|
|
updateBoardRollAxis(e);
|
|
});
|
|
self.pageElements.board_yaw_slider.Link('lower').to((e) => {
|
|
updateBoardYawAxis(e);
|
|
});
|
|
|
|
const elementToShow = $("#element_to_show");
|
|
elementToShow.change(function () {
|
|
const value = parseInt($(this).val());
|
|
self.showMagnetometer = (value == 0);
|
|
self.render3D();
|
|
});
|
|
|
|
function clamp(input, min, max) {
|
|
return Math.min(Math.max(parseInt($(input).val()), min), max);
|
|
}
|
|
|
|
self.pageElements.orientation_mag_e.change(function () {
|
|
SENSOR_ALIGNMENT.align_mag = parseInt($(this).val());
|
|
const degrees = getAxisDegreeWithPresetAndBoardOrientation(SENSOR_ALIGNMENT.align_mag);
|
|
presetUpdated(degrees);
|
|
});
|
|
|
|
self.pageElements.orientation_mag_e.on('mousedown', function () {
|
|
const degrees = getAxisDegreeWithPresetAndBoardOrientation(SENSOR_ALIGNMENT.align_mag);
|
|
presetUpdated(degrees);
|
|
});
|
|
|
|
self.pageElements.orientation_mag_roll.change(function () {
|
|
disableSavePreset();
|
|
updateRollAxis(clamp(this, -180, 360));
|
|
});
|
|
|
|
self.pageElements.orientation_mag_pitch.change(function () {
|
|
disableSavePreset();
|
|
updatePitchAxis(clamp(this, -180, 360));
|
|
});
|
|
|
|
self.pageElements.orientation_mag_yaw.change(function () {
|
|
disableSavePreset();
|
|
updateYawAxis(clamp(this, -180, 360));
|
|
});
|
|
|
|
$('a.save').click(function () {
|
|
saveChainer.execute()
|
|
});
|
|
|
|
self.pageElements.roll_slider.noUiSlider({
|
|
start: [self.alignmentConfig.roll],
|
|
range: {
|
|
'min': [-180],
|
|
'max': [360]
|
|
},
|
|
step: 1,
|
|
});
|
|
self.pageElements.roll_slider.noUiSlider_pips({
|
|
mode: 'values',
|
|
values: generateRange(-180, 360, 45),
|
|
density: 4,
|
|
stepped: true
|
|
});
|
|
|
|
self.pageElements.pitch_slider.noUiSlider({
|
|
start: [self.alignmentConfig.pitch],
|
|
range: {
|
|
'min': [-180],
|
|
'max': [360]
|
|
},
|
|
step: 1,
|
|
});
|
|
self.pageElements.pitch_slider.noUiSlider_pips({
|
|
mode: 'values',
|
|
values: generateRange(-180, 360, 45),
|
|
density: 4,
|
|
stepped: true
|
|
});
|
|
|
|
self.pageElements.yaw_slider.noUiSlider({
|
|
start: [self.alignmentConfig.yaw],
|
|
range: {
|
|
'min': [-180],
|
|
'max': [360]
|
|
},
|
|
step: 1,
|
|
});
|
|
self.pageElements.yaw_slider.noUiSlider_pips({
|
|
mode: 'values',
|
|
values: generateRange(-180, 360, 45),
|
|
density: 4,
|
|
stepped: true
|
|
});
|
|
|
|
|
|
self.pageElements.pitch_slider.Link('lower').to((e) => {
|
|
updatePitchAxis(e);
|
|
});
|
|
self.pageElements.roll_slider.Link('lower').to((e) => {
|
|
updateRollAxis(e);
|
|
});
|
|
self.pageElements.yaw_slider.Link('lower').to((e) => {
|
|
updateYawAxis(e);
|
|
});
|
|
|
|
self.pageElements.pitch_slider.on('slide', (e) => {
|
|
disableSavePreset();
|
|
});
|
|
self.pageElements.roll_slider.on('slide', (e) => {
|
|
disableSavePreset();
|
|
});
|
|
self.pageElements.yaw_slider.on('slide', (e) => {
|
|
disableSavePreset();
|
|
});
|
|
|
|
function get_fast_data() {
|
|
if (helper.mspQueue.shouldDrop()) {
|
|
return;
|
|
}
|
|
|
|
MSP.send_message(MSPCodes.MSP_ATTITUDE, false, false, function () {
|
|
self.roll_e.text(chrome.i18n.getMessage('initialSetupAttitude', [SENSOR_DATA.kinematics[0]]));
|
|
self.pitch_e.text(chrome.i18n.getMessage('initialSetupAttitude', [SENSOR_DATA.kinematics[1]]));
|
|
self.heading_e.text(chrome.i18n.getMessage('initialSetupAttitude', [SENSOR_DATA.kinematics[2]]));
|
|
self.render3D();
|
|
});
|
|
}
|
|
|
|
helper.mspBalancedInterval.add('setup_data_pull_fast', 40, 1, get_fast_data);
|
|
|
|
GUI.content_ready(callback);
|
|
}
|
|
|
|
};
|
|
|
|
|
|
TABS.magnetometer.initialize3D = function () {
|
|
|
|
var self = this,
|
|
canvas,
|
|
renderer,
|
|
wrapper,
|
|
modelWrapper,
|
|
model_file,
|
|
camera,
|
|
scene,
|
|
gps,
|
|
xyz,
|
|
fc,
|
|
useWebGlRenderer = false;
|
|
|
|
canvas = $('.model-and-info #canvas');
|
|
wrapper = $('.model-and-info #canvas_wrapper');
|
|
|
|
// webgl capability detector
|
|
// it would seem the webgl "enabling" through advanced settings will be ignored in the future
|
|
// and webgl will be supported if gpu supports it by default (canary 40.0.2175.0), keep an eye on this one
|
|
var detector_canvas = document.createElement('canvas');
|
|
if (window.WebGLRenderingContext && (detector_canvas.getContext('webgl') || detector_canvas.getContext('experimental-webgl'))) {
|
|
renderer = new THREE.WebGLRenderer({canvas: canvas.get(0), alpha: true, antialias: true});
|
|
useWebGlRenderer = true;
|
|
}
|
|
else {
|
|
renderer = new THREE.CanvasRenderer({canvas: canvas.get(0), alpha: true});
|
|
}
|
|
// initialize render size for current canvas size
|
|
renderer.setSize(wrapper.width() * 2, wrapper.height() * 2);
|
|
|
|
|
|
// modelWrapper adds an extra axis of rotation to avoid gimbal lock with the euler angles
|
|
modelWrapper = new THREE.Object3D();
|
|
|
|
// load the model including materials
|
|
if (useWebGlRenderer) {
|
|
if (MIXER_CONFIG.appliedMixerPreset === -1) {
|
|
model_file = 'custom';
|
|
GUI_control.prototype.log("<span style='color: red; font-weight: bolder'><strong>" + chrome.i18n.getMessage("mixerNotConfigured") + "</strong></span>");
|
|
}
|
|
else {
|
|
model_file = helper.mixer.getById(MIXER_CONFIG.appliedMixerPreset).model;
|
|
}
|
|
}
|
|
else {
|
|
model_file = 'fallback'
|
|
}
|
|
|
|
// Temporary workaround for 'custom' model until akfreak's custom model is merged.
|
|
if (model_file == 'custom') {
|
|
model_file = 'fallback';
|
|
}
|
|
|
|
this.render3D = function () {
|
|
|
|
if (!gps || !xyz || !fc)
|
|
return;
|
|
|
|
gps.visible = self.showMagnetometer;
|
|
xyz.visible = !self.showMagnetometer;
|
|
fc.visible = true;
|
|
|
|
var magRotation = new THREE.Euler(-THREE.Math.degToRad(self.alignmentConfig.pitch-180), THREE.Math.degToRad(-180 - self.alignmentConfig.yaw), THREE.Math.degToRad(self.alignmentConfig.roll), 'YXZ');
|
|
var matrix = (new THREE.Matrix4()).makeRotationFromEuler(magRotation);
|
|
|
|
var boardRotation = new THREE.Euler( THREE.Math.degToRad( self.boardAlignmentConfig.pitch), THREE.Math.degToRad( -self.boardAlignmentConfig.yaw ), THREE.Math.degToRad( self.boardAlignmentConfig.roll ), 'YXZ');
|
|
var matrix1 = (new THREE.Matrix4()).makeRotationFromEuler(boardRotation);
|
|
|
|
/*
|
|
if ( self.isSavePreset ) {
|
|
matrix.premultiply(matrix1); //preset specifies orientation relative to FC, align_max_xxx specify absolute orientation
|
|
}
|
|
*/
|
|
gps.rotation.setFromRotationMatrix(matrix);
|
|
xyz.rotation.setFromRotationMatrix(matrix);
|
|
fc.rotation.setFromRotationMatrix(matrix1);
|
|
|
|
// draw
|
|
if (camera != null)
|
|
renderer.render(scene, camera);
|
|
};
|
|
|
|
// handle canvas resize
|
|
this.resize3D = function () {
|
|
renderer.setSize(wrapper.width() * 2, wrapper.height() * 2);
|
|
camera.aspect = wrapper.width() / wrapper.height();
|
|
camera.updateProjectionMatrix();
|
|
|
|
this.render3D();
|
|
};
|
|
|
|
$(window).on('resize', this.resize3D);
|
|
|
|
let getDistanceByModelName = function (name) {
|
|
switch (name) {
|
|
case "quad_x":
|
|
return [0, 0, 3];
|
|
case "quad_vtail":
|
|
return [0, 0, 4.5];
|
|
case "quad_atail":
|
|
return [0, 0, 5];
|
|
case "y4":
|
|
case "y6":
|
|
case "tricopter":
|
|
return [0, 1.4, 0];
|
|
case "hex_x":
|
|
case "hex_plus":
|
|
return [0, 2, 0];
|
|
case "flying_wing":
|
|
case "rudderless_plane":
|
|
case "twin_plane":
|
|
case "vtail_plane":
|
|
case "vtail_single_servo_plane":
|
|
return [0, 1.6, 0];
|
|
case "fallback":
|
|
default:
|
|
return [0, 2.5, 0];
|
|
|
|
}
|
|
};
|
|
|
|
// setup scene
|
|
scene = new THREE.Scene();
|
|
|
|
// stationary camera
|
|
camera = new THREE.PerspectiveCamera(50, wrapper.width() / wrapper.height(), 1, 10000);
|
|
camera.position.set(-95, 82, 50);
|
|
let controls = new THREE.OrbitControls(camera, renderer.domElement);
|
|
controls.update();
|
|
controls.addEventListener( 'change', this.render3D );
|
|
|
|
// some light
|
|
const light = new THREE.AmbientLight(0x808080);
|
|
const light2 = new THREE.DirectionalLight(new THREE.Color(1, 1, 1), 1);
|
|
const light3 = new THREE.DirectionalLight(new THREE.Color(1, 1, 1), 1);
|
|
light2.position.set(0, 1, 0);
|
|
light3.position.set(0, -1, 0);
|
|
|
|
// add camera, model, light to the foreground scene
|
|
scene.add(light);
|
|
scene.add(light2);
|
|
scene.add(light3);
|
|
scene.add(camera);
|
|
scene.add(modelWrapper);
|
|
|
|
//Load the models
|
|
const manager = new THREE.LoadingManager();
|
|
const loader = new THREE.GLTFLoader(manager);
|
|
|
|
//Load the UAV model
|
|
loader.load('./resources/models/' + model_file + '.gltf', (obj) => {
|
|
const model = obj.scene;
|
|
const scaleFactor = 15;
|
|
model.scale.set(scaleFactor, scaleFactor, scaleFactor);
|
|
modelWrapper.add(model);
|
|
|
|
const gpsOffset = getDistanceByModelName(model_file);
|
|
|
|
//Load the GPS model
|
|
loader.load('./resources/models/gps.gltf', (obj) => {
|
|
gps = obj.scene;
|
|
const scaleFactor = 0.04;
|
|
gps.scale.set(scaleFactor, scaleFactor, scaleFactor);
|
|
gps.position.set(gpsOffset[0], gpsOffset[1] + 0.5, gpsOffset[2]);
|
|
gps.traverse(child => {
|
|
if (child.material) child.material.metalness = 0;
|
|
});
|
|
gps.rotation.y = 3 * Math.PI / 2;
|
|
model.add(gps);
|
|
this.resize3D();
|
|
});
|
|
|
|
//Load the XYZ model
|
|
loader.load('./resources/models/xyz.gltf', (obj) => {
|
|
xyz = obj.scene;
|
|
const scaleFactor = 0.04;
|
|
xyz.scale.set(scaleFactor, scaleFactor, scaleFactor);
|
|
xyz.position.set(gpsOffset[0], gpsOffset[1] + 0.5, gpsOffset[2]);
|
|
xyz.rotation.y = 3 * Math.PI / 2;
|
|
model.add(xyz);
|
|
this.render3D();
|
|
});
|
|
|
|
//Load the FC model
|
|
loader.load('./resources/models/fc.gltf', (obj) => {
|
|
fc = obj.scene;
|
|
const scaleFactor = 0.04;
|
|
fc.scale.set(scaleFactor, scaleFactor, scaleFactor);
|
|
fc.position.set(gpsOffset[0], gpsOffset[1] - 0.5, gpsOffset[2]);
|
|
fc.rotation.y = 3 * Math.PI / 2;
|
|
model.add(fc);
|
|
this.render3D();
|
|
});
|
|
|
|
});
|
|
this.render3D();
|
|
this.resize3D();
|
|
};
|
|
|
|
|
|
TABS.magnetometer.cleanup = function (callback) {
|
|
$(window).off('resize', this.resize3D);
|
|
|
|
if (callback) callback();
|
|
};
|