Add initial MCU software
This commit is contained in:
parent
6402bd7efd
commit
f88a987204
24
microcontroller/ctrl.py
Normal file
24
microcontroller/ctrl.py
Normal file
@ -0,0 +1,24 @@
|
|||||||
|
import serial
|
||||||
|
|
||||||
|
channels = [
|
||||||
|
192, # pan
|
||||||
|
0, # tilt
|
||||||
|
134, # dimmer
|
||||||
|
255, # R
|
||||||
|
255, # G
|
||||||
|
255, # B
|
||||||
|
0, # W
|
||||||
|
1, # movement speed
|
||||||
|
0, # RST
|
||||||
|
]
|
||||||
|
|
||||||
|
ser = serial.Serial("/dev/ttyUSB0", 115200)
|
||||||
|
|
||||||
|
payload = bytearray()
|
||||||
|
payload.extend(5 * [0])
|
||||||
|
payload.extend(channels)
|
||||||
|
|
||||||
|
ser.write(payload)
|
||||||
|
ser.flush()
|
||||||
|
|
||||||
|
print(ser.read_all())
|
70
microcontroller/test.ino
Normal file
70
microcontroller/test.ino
Normal file
@ -0,0 +1,70 @@
|
|||||||
|
unsigned long tic_loop = 0;
|
||||||
|
const unsigned int FRAME_TIME = 25; // 20 ms -> 50 FPS
|
||||||
|
|
||||||
|
byte channels_buffer[512] = {0};
|
||||||
|
byte read_buffer[9] = {0};
|
||||||
|
size_t bytes_read = 0;
|
||||||
|
|
||||||
|
const unsigned int START_ADDR = 10;
|
||||||
|
const unsigned int NUM_CHANNELS = 9;
|
||||||
|
|
||||||
|
unsigned int bytes_to_write = START_ADDR + NUM_CHANNELS;
|
||||||
|
|
||||||
|
void setup()
|
||||||
|
{
|
||||||
|
Serial.begin(115200); // USB
|
||||||
|
|
||||||
|
while (!Serial.available());
|
||||||
|
Serial.println();
|
||||||
|
Serial.println("INIT");
|
||||||
|
|
||||||
|
Serial1.begin(250000, SERIAL_8N2); // DMX
|
||||||
|
tic_loop = millis();
|
||||||
|
}
|
||||||
|
|
||||||
|
void loop()
|
||||||
|
{
|
||||||
|
update_buffer();
|
||||||
|
|
||||||
|
// this section gets executed at a maximum rate of around 40Hz
|
||||||
|
if ((millis() - tic_loop) > FRAME_TIME)
|
||||||
|
{
|
||||||
|
tic_loop = millis();
|
||||||
|
|
||||||
|
send_dmx_header();
|
||||||
|
Serial1.write(channels_buffer, bytes_to_write);
|
||||||
|
}
|
||||||
|
delay(1);
|
||||||
|
}
|
||||||
|
|
||||||
|
void update_buffer()
|
||||||
|
{
|
||||||
|
if (!Serial.available()) return;
|
||||||
|
Serial.read(read_buffer + bytes_read, 1);
|
||||||
|
Serial.print(".");
|
||||||
|
|
||||||
|
bytes_read += 1;
|
||||||
|
if (bytes_read == NUM_CHANNELS) {
|
||||||
|
bytes_read = 0;
|
||||||
|
memcpy(channels_buffer + START_ADDR - 1, read_buffer, NUM_CHANNELS);
|
||||||
|
Serial.println();
|
||||||
|
Serial.println("Updated.");
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void send_dmx_header()
|
||||||
|
{
|
||||||
|
Serial1.flush();
|
||||||
|
Serial1.begin(90000, SERIAL_8N2);
|
||||||
|
while (Serial1.available())
|
||||||
|
Serial1.read();
|
||||||
|
// send the break as a "slow" byte
|
||||||
|
Serial1.write(0);
|
||||||
|
// switch back to the original baud rate
|
||||||
|
Serial1.flush();
|
||||||
|
Serial1.begin(250000, SERIAL_8N2);
|
||||||
|
while (Serial1.available())
|
||||||
|
Serial1.read();
|
||||||
|
|
||||||
|
Serial1.write(0); // Start-Byte
|
||||||
|
}
|
87
microcontroller/works_static.ino.bak
Normal file
87
microcontroller/works_static.ino.bak
Normal file
@ -0,0 +1,87 @@
|
|||||||
|
unsigned long tic_loop = 0;
|
||||||
|
const unsigned int FRAME_TIME = 25; // 20 ms -> 50 FPS
|
||||||
|
|
||||||
|
byte channels_buffer[512] = {0};
|
||||||
|
unsigned int bytes_to_write = 512;
|
||||||
|
|
||||||
|
const unsigned int START_ADDR = 10;
|
||||||
|
const unsigned int NUM_CHANNELS = 9;
|
||||||
|
|
||||||
|
byte dmx_data[] = {
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
134,
|
||||||
|
255,
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
0,
|
||||||
|
};
|
||||||
|
|
||||||
|
void setup()
|
||||||
|
{
|
||||||
|
Serial.begin(115200); // USB
|
||||||
|
|
||||||
|
Serial1.begin(250000, SERIAL_8N2); // DMX
|
||||||
|
tic_loop = millis();
|
||||||
|
|
||||||
|
for (int i = 0; i < NUM_CHANNELS; ++i)
|
||||||
|
{
|
||||||
|
channels_buffer[START_ADDR - 1 + i] = dmx_data[i];
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void loop()
|
||||||
|
{
|
||||||
|
// update_buffer();
|
||||||
|
|
||||||
|
// this section gets executed at a maximum rate of around 40Hz
|
||||||
|
if ((millis() - tic_loop) > FRAME_TIME)
|
||||||
|
{
|
||||||
|
tic_loop = millis();
|
||||||
|
|
||||||
|
send_dmx_header();
|
||||||
|
Serial1.write(channels_buffer, bytes_to_write);
|
||||||
|
}
|
||||||
|
delay(1);
|
||||||
|
}
|
||||||
|
|
||||||
|
void update_buffer()
|
||||||
|
{
|
||||||
|
int n = Serial.available();
|
||||||
|
|
||||||
|
if (n < 1)
|
||||||
|
return;
|
||||||
|
|
||||||
|
n -= 1;
|
||||||
|
|
||||||
|
if (Serial.read() == n)
|
||||||
|
{
|
||||||
|
Serial.read(channels_buffer, n);
|
||||||
|
bytes_to_write = n;
|
||||||
|
}
|
||||||
|
else
|
||||||
|
{
|
||||||
|
// incomplete
|
||||||
|
while (Serial.available())
|
||||||
|
Serial.read();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void send_dmx_header()
|
||||||
|
{
|
||||||
|
Serial1.flush();
|
||||||
|
Serial1.begin(90000, SERIAL_8N2);
|
||||||
|
while (Serial1.available())
|
||||||
|
Serial1.read();
|
||||||
|
// send the break as a "slow" byte
|
||||||
|
Serial1.write(0);
|
||||||
|
// switch back to the original baud rate
|
||||||
|
Serial1.flush();
|
||||||
|
Serial1.begin(250000, SERIAL_8N2);
|
||||||
|
while (Serial1.available())
|
||||||
|
Serial1.read();
|
||||||
|
|
||||||
|
Serial1.write(0); // Start-Byte
|
||||||
|
}
|
Loading…
Reference in New Issue
Block a user