Number of queues in op_queue now defined at compile time

Closes OpenMYR#42

SConstruct

@@ -11,4 +11,4 @@ base_env = Environment(
 Export('base_env')
 
 SConscript('src/SConscript', variant_dir = './build/out', duplicate = 0)
-SConscript('build/SConscript')
+SConscript('build/SConscript')

build/SConscript

@@ -15,4 +15,6 @@ base_env.Alias('flash-stepper', base_env.Command(None, ['bin/stepper_driver-0x00
 Clean('.', 'bin')
 Clean('.', 'out')
 
-Default('quad', 'stepper')
+Default('quad', 'stepper')
+if GetOption("clean"):
+	Default('.')

src/SConscript

@@ -1,4 +1,12 @@
 Import('base_env')
 
-base_env.Program('stepper_driver', ['main.c', 'hw_timer.c', 'command_layer.c', 'stepper_driver.c', 'udp.c', 'tcp.c', 'wifi.c', 'op_queue.c', 'jsmn.c'])
-base_env.Program('quad_servo_driver', ['main.c', 'hw_timer.c', 'command_layer.c', 'quad_servo_driver.c', 'udp.c', 'tcp.c', 'wifi.c', 'quad_op_queue.c', 'jsmn.c'])
+quad_queue = base_env.Clone();
+quad_queue.Append(CCFLAGS = ['-DMOTOR_COUNT=4'])
+quad_queue.Object(source = 'op_queue.c', target = 'quad_op_queue.o')
+
+stepper_queue = base_env.Clone();
+stepper_queue.Append(CCFLAGS = ['-DMOTOR_COUNT=1'])
+stepper_queue.Object(source = 'op_queue.c', target = 'stepper_op_queue.o')
+
+base_env.Program('stepper_driver', ['main.c', 'hw_timer.c', 'command_layer.c', 'stepper_driver.c', 'udp.c', 'tcp.c', 'wifi.c', 'stepper_op_queue.o', 'jsmn.c'])
+base_env.Program('quad_servo_driver', ['main.c', 'hw_timer.c', 'command_layer.c', 'quad_servo_driver.c', 'udp.c', 'tcp.c', 'wifi.c', 'quad_op_queue.o', 'jsmn.c'])

src/op_queue.c

@@ -1,7 +1,6 @@
 #include "op_queue.h"
 #include "osapi.h"
 
-#define MOTOR_COUNT 1
 #define BUFFER_SIZE (1000 / MOTOR_COUNT)
 
 static struct stepper_command_data command_queue[MOTOR_COUNT][BUFFER_SIZE];