CuboBmsTool/mobile/DetectBldc.qml

/*
    Copyright 2018 Benjamin Vedder	benjamin@vedder.se

    This file is part of VESC Tool.

    VESC Tool is free software: you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation, either version 3 of the License, or
    (at your option) any later version.

    VESC Tool is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program.  If not, see <http://www.gnu.org/licenses/>.
    */

import QtQuick 2.7
import QtQuick.Controls 2.2
import QtQuick.Layouts 1.3

import Vedder.vesc.bmsinterface 1.0
import Vedder.vesc.commands 1.0
import Vedder.vesc.configparams 1.0

Item {
    property int parentWidth: 10
    property real intLim: 0.0
    property real coupling: 0.0
    property var hallTable: []
    property int hallRes: -4
    property bool resultReceived: false

    property Commands mCommands: VescIf.commands()
    property ConfigParams mbmsConfig: VescIf.bmsConfig()
    property ConfigParams mInfoConf: VescIf.infoConfig()

    function openDialog() {
        dialog.open()
    }

    function updateDisplay() {
        var txt = ""

        txt +=
                "Integrator limit : " + parseFloat(intLim).toFixed(2) + "\n" +
                "BEMF Coupling    : " + parseFloat(coupling).toFixed(2) + "\n"

        if (hallRes == 0) {
            txt += "Detected hall sensor table:\n"
            for (var i = 0;i < hallTable.length;i++) {
                txt += "" + hallTable[i]

                if (i != hallTable.length - 1) {
                    txt += ", "
                }
            }
        } else if (hallRes == -1) {
            txt += "Hall sensor detection failed:\n"
            for (var i = 0;i < hallTable.length;i++) {
                txt += "" + hallTable[i]

                if (i != hallTable.length - 1) {
                    txt += ", "
                }
            }
        } else if (hallRes == -2) {
            txt += "WS2811 enabled. Hall sensors cannot be used."
        } else if (hallRes == -3) {
            txt += "Encoder enabled. Hall sensors cannot be used."
        } else if (hallRes == -4) {
            txt += "Detected hall sensor table:"
        } else {
            txt += "Unknown hall error: " + hallRes
        }

        resultArea.text = txt
    }

    function testConnected() {
        if (VescIf.isPortConnected()) {
            return true
        } else {
            VescIf.emitMessageDialog(
                        "Connection Error",
                        "The VESC is not connected. Please connect it to run detection.",
                        false, false)
            return false
        }
    }

    Component.onCompleted: {
        updateDisplay()
    }

    Dialog {
        id: dialog
        standardButtons: Dialog.Close
        modal: true
        focus: true
        width: parentWidth - 20
        height: Math.min(implicitHeight, column.height - 40)
        closePolicy: Popup.CloseOnEscape
        x: 10
        y: 10

        ScrollView {
            anchors.fill: parent
            clip: true
            contentWidth: parent.width
            ColumnLayout {
                anchors.fill: parent
                spacing: 0

                DoubleSpinBox {
                    id: currentBox
                    Layout.fillWidth: true
                    decimals: 2
                    realValue: 5.0
                    realFrom: 0.0
                    realTo: 200.0
                    prefix: "I: "
                    suffix: " A"
                }

                DoubleSpinBox {
                    id: dutyBox
                    Layout.fillWidth: true
                    decimals: 2
                    realValue: 0.05
                    realFrom: 0.0
                    realTo: 1.0
                    realStepSize: 0.01
                    prefix: "D: "
                }

                DoubleSpinBox {
                    id: erpmBox
                    Layout.fillWidth: true
                    decimals: 1
                    realValue: 450.0
                    realFrom: 0.0
                    realTo: 20000.0
                    realStepSize: 10.0
                    prefix: "\u03C9: "
                    suffix: " ERPM"
                }

                RowLayout {
                    Layout.fillWidth: true
                    Button {
                        text: "Help"
                        Layout.fillWidth: true
                        Layout.preferredWidth: 50
                        onClicked: {
                            VescIf.emitMessageDialog(
                                        mInfoConf.getLongName("help_bldc_detect"),
                                        mInfoConf.getDescription("help_bldc_detect"),
                                        true, true)
                        }
                    }

                    Button {
                        text: "Detect"
                        Layout.preferredWidth: 50
                        Layout.fillWidth: true
                        onClicked: {
                            if (!testConnected()) {
                                return
                            }

                            detectDialog.open()
                        }
                    }
                }

                TextArea {
                    id: resultArea
                    Layout.fillWidth: true
                    Layout.preferredHeight: 180
                    readOnly: true
                    font.family: "DejaVu Sans Mono"
                }

                Button {
                    text: "Apply & Close"
                    Layout.fillWidth: true
                    onClicked: {
                        if (!resultReceived) {
                            VescIf.emitMessageDialog("Apply Detection Result",
                                                     "Detection result not received. Make sure to run the detection first.",
                                                     false, false)
                            return
                        }

                        mbmsConfig.updateParamDouble("sl_bemf_coupling_k", coupling)
                        mbmsConfig.updateParamDouble("sl_cycle_int_limit", intLim)

                        if (hallRes == 0) {
                            for(var i = 0;i < 7;i++) {
                                mbmsConfig.updateParamInt("hall_table_" + i, hallTable[i])
                            }
                        }

                        dialog.close()
                    }
                }
            }
        }
    }

    Dialog {
        id: detectDialog
        standardButtons: Dialog.Ok | Dialog.Cancel
        modal: true
        focus: true
        width: parentWidth - 20
        closePolicy: Popup.CloseOnEscape
        title: "Detect BLDC Parameters"

        x: 10
        y: dialog.y + dialog.height / 2 - height / 2

        Text {
            id: detectLabel
            verticalAlignment: Text.AlignVCenter
            anchors.fill: parent
            wrapMode: Text.WordWrap
            text:
                "This is going to spin up the motor. Make " +
                "sure that nothing is in the way."
        }

        onAccepted: {
            mCommands.detectMotorParam(currentBox.realValue, erpmBox.realValue, dutyBox.realValue)
        }
    }

    Connections {
        target: mCommands

        onBldcDetectReceived: {
            if (param.cycle_int_limit < 0.01 && param.bemf_coupling_k < 0.01) {
                VescIf.emitStatusMessage("Bad Detection Result Received", false)
                VescIf.emitMessageDialog("BLDC Detection",
                                         "Bad Detection Result Received",
                                         false, false)
            } else {
                VescIf.emitStatusMessage("Detection Result Received", true)
                intLim = param.cycle_int_limit
                coupling = param.bemf_coupling_k
                hallTable = param.hall_table
                hallRes = param.hall_res
                resultReceived = true

                updateDisplay()
            }
        }
    }
}