realrobotshk
/
sophia_controller
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

animation save payload to esp32 now includes node graph, nodes, and connections

node_mode
Jake 2025-10-15 00:40:27 +08:00
parent 83710c095e
commit 1c3bab83ec
3 changed files with 67 additions and 50 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

49
curveEditor.js
View File

@ -80,6 +80,55 @@ export class CurveEditor {
console.log(this.curveSets);
}
encodeCurves() {
const bufferSize = 1024; // adjust based on expected graph size
const buffer = new ArrayBuffer(bufferSize);
const view = new DataView(buffer);
let offset = 0;
const curveSegments = [];
Object.entries(this.curveSets).forEach(([motorIDStr, segments]) => {
const motorID = parseInt(motorIDStr, 10);
segments.forEach(segment => {
curveSegments.push({
motorID,
startTime: segment.startPoint.x,
endTime: segment.endPoint.x,
startPointY: segment.startPoint.y,
startHandleX: segment.startPointHandle.x,
startHandleY: segment.startPointHandle.y,
endHandleX: segment.endPointHandle.x,
endHandleY: segment.endPointHandle.y,
endPointY: segment.endPoint.y
});
});
});
console.log(curveSegments);
const curveCount = curveSegments.length;
view.setUint16(offset, curveCount, true); offset += 2;
// 🔹 Curve segments
curveSegments.forEach(seg => {
console.log(offset, seg.motorID);
view.setUint8(offset++, seg.motorID);
view.setUint16(offset, seg.startTime, true); offset += 2;
view.setUint16(offset, seg.endTime, true); offset += 2;
view.setInt16(offset, this.yToExportRange(seg.startPointY), true); offset += 2;
view.setUint16(offset, seg.startHandleX, true); offset += 2;
view.setInt16(offset, this.yToExportRange(seg.startHandleY), true); offset += 2;
view.setUint16(offset, seg.endHandleX, true); offset += 2;
view.setInt16(offset, this.yToExportRange(seg.endHandleY), true); offset += 2;
view.setInt16(offset, this.yToExportRange(seg.endPointY), true); offset += 2;
});
console.log("🧵 Curve segments packed:", curveSegments.length);
console.log(curveSegments);
return new Uint8Array(buffer.slice(0, offset));
}
addChannel(motorID) {
this.setCurves([
{

3
nodeeditor/NodeEditor.js
View File

@ -57,6 +57,9 @@ export class NodeEditor {
view.setUint8(offset++, node.type); // Node type
view.setUint8(offset++, node.id); // Node ID
view.setUint16(offset, node.x, true); offset+=2;
view.setUint16(offset, node.y, true); offset+=2;
switch (node.type) {
case NODE_TYPES.Servo:

61
script.js
View File

@ -510,8 +510,8 @@ window.onload = () => {
const endHandleY = view.getInt16(offset, true); offset += 2;
const endPointY = view.getInt16(offset, true); offset += 2;
console.log("RECEIVED VALUES RAW:");
console.log(startTime, endTime, startPointY, endPointY);
//console.log("RECEIVED VALUES RAW:");
//console.log(startTime, endTime, startPointY, endPointY);
const toFloat = v => (v / 65535) * 2 - 1;
@ -586,38 +586,11 @@ window.onload = () => {
const version = 1;
const headerSize = 16;
const curveSegments = [];
// 🔹 Collect all curve segments
Object.entries(curveEditor.curveSets).forEach(([motorIDStr, segments]) => {
const motorID = parseInt(motorIDStr, 10);
segments.forEach(segment => {
const toTime = x => Math.max(0, Math.round(curveEditor.xToValue(x) * 100)); // seconds → centiseconds
const toUint16 = v => {
const normalized = Math.max(-1, Math.min(1, v)); // clamp to [-1, 1]
return Math.round((normalized + 1) / 2 * 65535);
};
curveSegments.push({
motorID,
startTime: segment.startPoint.x,
endTime: segment.endPoint.x,
startPointY: segment.startPoint.y,
startHandleX: segment.startPointHandle.x,
startHandleY: segment.startPointHandle.y,
endHandleX: segment.endPointHandle.x,
endHandleY: segment.endPointHandle.y,
endPointY: segment.endPoint.y
});
});
});
const curveCount = curveSegments.length;
const segmentSize = 17;
const filenameBytes = new TextEncoder().encode(filename);
const filenameLength = filenameBytes.length;
const totalSize = 2 + filenameLength + headerSize + 2 + curveCount * segmentSize;
const totalSize = 1024;
const buffer = new ArrayBuffer(totalSize);
const view = new DataView(buffer);
let offset = 0;
@ -636,28 +609,19 @@ window.onload = () => {
view.setUint8(offset++, frameRate);
offset += 8; // reserved
// 🔹 Curve count
view.setUint16(offset, curveCount, true); offset += 2;
// 🔹 Curve segments
let curvePacket = curveEditor.encodeCurves()
let nodeGraphPacket = nodeEditor.encodeNodeGraph();
curveSegments.forEach(seg => {
view.setUint8(offset++, seg.motorID);
view.setUint16(offset, seg.startTime, true); offset += 2;
view.setUint16(offset, seg.endTime, true); offset += 2;
view.setInt16(offset, curveEditor.yToExportRange(seg.startPointY), true); offset += 2;
view.setUint16(offset, seg.startHandleX, true); offset += 2;
view.setInt16(offset, curveEditor.yToExportRange(seg.startHandleY), true); offset += 2;
view.setUint16(offset, seg.endHandleX, true); offset += 2;
view.setInt16(offset, curveEditor.yToExportRange(seg.endHandleY), true); offset += 2;
view.setInt16(offset, curveEditor.yToExportRange(seg.endPointY), true); offset += 2;
});
console.log("🧵 Curve segments packed:", curveSegments.length);
console.log(curveSegments);
// 🔹 Append nodeGraphPacket
// 🔹 Append curvePacket
curvePacket.forEach(byte => view.setUint8(offset++, byte));
nodeGraphPacket.forEach(byte => view.setUint8(offset++, byte));
// 🔹 Send to ESP32
const payload = new Uint8Array(buffer);
const payload = new Uint8Array(buffer.slice(0, offset));
console.log()
console.log(payload);
serial.saveFile(payload); // CMD_SAVE_ANIMATION
@ -711,7 +675,8 @@ window.onload = () => {
};
document.getElementById('sendNodes').onclick = async () => {
console.log(nodeEditor.encodeNodeGraph());
nodeGraphPacket = nodeEditor.encodeNodeGraph();
curvePacket = curveEditor.encodeCurves()
};