kdrakontidis/throttle_motor_mapping
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

Send msg on apps & bug fix

Browse Source
This commit is contained in:
admin
2025-06-18 18:44:39 +02:00
parent 85845da0b8
commit 7006e8ccc6
1 changed files with 16 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files
can.js
+16 -6
View File
@@ -16,11 +16,13 @@ var loaded_map_name = null;
var loaded_map_data = []; var loaded_map_data = [];
var throttle_output = 0; var throttle_output = 0;
var ERPM = 0;
var enabled = false; var enabled = false;
var channel = can.createRawChannel(can_conf.network_id, true); var channel = can.createRawChannel(can_conf.network_id, true);
// Some test messages...
// 404#0000245E00710186 // 404#0000245E00710186
// 019#02 // 019#02
// 050#9702 // 050#9702
@@ -128,18 +130,26 @@ channel.addListener("onMessage", async function (message) {
break; break;
case can_conf.apps_id: case can_conf.apps_id:
const apps_percentage = ((message.data[1] << 8) | message.data[0]) / 1000; const apps_percentage = ((message.data[1] << 8) | message.data[0]) / 1000;
var max_current = 0;
throttle_output = 0;
if (loaded_map_name !== null) { if (loaded_map_name !== null) {
throttle_output = loaded_map_data[getMapIndex(map_throttle, apps_percentage)][2]; throttle_output = loaded_map_data[getMapIndex(map_throttle, apps_percentage)][2];
} else { max_current = loaded_map_data[getMapIndex(map_rpm, ERPM / can_conf.motor_poles)][(throttle_output > 0) ? 0 : 1];
throttle_output = 0;
} }
let current = throttle_output * max_current * 10;
channel.send({
id: (throttle_output > 0) ? current_id : brake_current_id,
ext: false,
data: Buffer.from([(current >> 8) & 0xFF, current & 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF])
});
break; break;
case erpm_id: case erpm_id:
if (enabled && (loaded_map_name !== null)) { if ((enabled == true) && (loaded_map_name !== null)) {
const ERPM = message.data[0] << 3 * 8 | message.data[1] << 2 * 8 | message.data[2] << 8 | message.data[3]; ERPM = message.data[0] << 3 * 8 | message.data[1] << 2 * 8 | message.data[2] << 8 | message.data[3];
let max_current = loaded_map_data[getMapIndex(map_rpm, ERPM / can_conf.motor_poles)][(throttle_output > 0) ? 0 : 1]; let max_current = loaded_map_data[getMapIndex(map_rpm, ERPM / can_conf.motor_poles)][(throttle_output > 0) ? 0 : 1];
let current = throttle_output * max_current * 10; let current = throttle_output * max_current * 10;
channel.send({ channel.send({
@@ -147,7 +157,7 @@ channel.addListener("onMessage", async function (message) {
ext: false, ext: false,
data: Buffer.from([(current >> 8) & 0xFF, current & 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF]) data: Buffer.from([(current >> 8) & 0xFF, current & 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF])
}); });
} else if (enabled && (loaded_map_data === null)) { } else if ((enabled == true) && (loaded_map_name === null)) {
channel.send({ channel.send({
id: brake_current_id, id: brake_current_id,
ext: false, ext: false,