Add motor control translation

This takes the differential steering values and maps them to motor commands

lib/motor_control.js

@@ -0,0 +1,44 @@
+var diffSteer = require('./diff_steer');
+
+function explicate(motorSpeed) {
+  leftMotorDirection = motorSpeed > 0 ? motorControl.revMethod : motorControl.fwdMethod;
+  leftMotorSpeed = Math.abs(motorSpeed);
+  return [leftMotorDirection, leftMotorSpeed];
+}
+
+function motorControl(wheels, leftRightAxis, upDownAxis, maxAxis, minAxis, maxSpeed, axisFlip) {
+  var leftMotor;
+  var leftMotorDirection;
+  var leftMotorSpeed = 0;
+  var motorSpeeds;
+  var rightMotor;
+  var rightMotorDirection;
+  var rightMotorSpeed = 0;
+
+  // Map differential steering values to motor commands
+  motorSpeeds = diffSteer(leftRightAxis, upDownAxis, maxAxis, minAxis, maxSpeed, axisFlip);
+  leftMotor = explicate(motorSpeeds[0]);
+  leftMotorDirection = leftMotor[0];
+  leftMotorSpeed = leftMotor[1];
+  rightMotor = explicate(motorSpeeds[1]);
+  rightMotorDirection = rightMotor[0];
+  rightMotorSpeed = rightMotor[1];
+
+  wheels[0][leftMotorDirection](leftMotorSpeed);
+  wheels[1][rightMotorDirection](rightMotorSpeed);
+
+  return [
+    {
+      direction: leftMotorDirection,
+      speed: leftMotorSpeed
+    },
+    {
+      direction: rightMotorDirection,
+      speed: rightMotorSpeed
+    }
+  ];
+}
+motorControl.fwdMethod = 'fwd';
+motorControl.revMethod = 'rev';
+
+module.exports = motorControl;

motor_control.js

@@ -0,0 +1 @@
+module.exports = require('./lib/motor_control');