public static void Run() { var leftMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D3, Pins.GPIO_PIN_D1, Pins.GPIO_PIN_D2); var rightMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D6, Pins.GPIO_PIN_D4, Pins.GPIO_PIN_D5); var robot = new TwoWheeledRobot(leftMotor, rightMotor); new SineWave(0.1, 0.5, 0.5, updateFrequency: 9).Output.ConnectTo(robot.SpeedInput); new SineWave(0.5, 0.333, 0, updateFrequency: 11).Output.ConnectTo(robot.DirectionInput); }
public static void Main() { // // Controls server // // initialize the serial port for COM1 (using D0 & D1) // initialize the serial port for COM3 (using D7 & D8) var serialPort = new SerialPort(SerialPorts.COM3, 57600, Parity.None, 8, StopBits.One); serialPort.Open(); var server = new ControlServer(serialPort); // // Just some diagnostic stuff // var uptimeVar = server.RegisterVariable("Uptime (s)", 0); var lv = false; var led = new Microsoft.SPOT.Hardware.OutputPort(Pins.ONBOARD_LED, lv); // // Make the robot // var leftMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D3, Pins.GPIO_PIN_D1, Pins.GPIO_PIN_D2); var rightMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D6, Pins.GPIO_PIN_D4, Pins.GPIO_PIN_D5); var robot = new TwoWheeledRobot(leftMotor, rightMotor); // // Expose some variables to control it // robot.SpeedInput.ConnectTo(server, writeable: true, name: "Speed"); robot.DirectionInput.ConnectTo(server, writeable: true, name: "Turn"); leftMotor.SpeedInput.ConnectTo(server); rightMotor.SpeedInput.ConnectTo(server); // // Show diagnostics // for (var i = 0; true; i++) { uptimeVar.Value = i; led.Write(lv); lv = !lv; Thread.Sleep(1000); } }
public static void Main6() { //Create our "Blocks" var leftMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D3, Pins.GPIO_PIN_D1, Pins.GPIO_PIN_D2); var rightMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D6, Pins.GPIO_PIN_D4, Pins.GPIO_PIN_D5); leftMotor.CalibrationInput.Value = 1; rightMotor.CalibrationInput.Value = 1; var awesomeBlock = new AwesomeBlock(Pins.ONBOARD_BTN, Pins.ONBOARD_LED, leftMotor, rightMotor); int i = 0; while (true) { Thread.Sleep(1000); // sleep for 1000ms Debug.Print("Looping" + i); i++; } }
public static void Main6() { //Create our "Blocks" var button = new DigitalInputPin(Pins.ONBOARD_BTN); var led = new DigitalOutputPin(Pins.ONBOARD_LED); var leftMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D3, Pins.GPIO_PIN_D1, Pins.GPIO_PIN_D2); leftMotor.CalibrationInput.Value = 1; var rightMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D6, Pins.GPIO_PIN_D4, Pins.GPIO_PIN_D5); rightMotor.CalibrationInput.Value = 1; button.Output.ConnectTo(led.Input); button.Output.ConnectTo(rightMotor.SpeedInput); button.Output.ConnectTo(leftMotor.SpeedInput); Thread.Sleep(Timeout.Infinite); }
public static void Run() { // // Start with the basic robot // var leftMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D3, Pins.GPIO_PIN_D1, Pins.GPIO_PIN_D2); var rightMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D6, Pins.GPIO_PIN_D4, Pins.GPIO_PIN_D5); var robot = new TwoWheeledRobot(leftMotor, rightMotor); // // Create a range finder and scope it // var scope = new DebugScope(); var a0 = new AnalogInputPin(AnalogChannels.ANALOG_PIN_A0, 10); scope.ConnectTo(a0.Analog); var sharp = new SharpGP2D12(); a0.Analog.ConnectTo(sharp.AnalogInput); scope.ConnectTo(sharp.DistanceOutput); scope.ConnectTo(robot.SpeedInput); // // This is the cruising (unobstructed) speed // var distanceToSpeed = new Transform(distance => { const double min = 0.1; const double max = 0.5; if (distance > max) { return(1.0); } else if (distance < min) { return(0.0); } return((distance - min) / (max - min)); }); distanceToSpeed.Input.ConnectTo(sharp.DistanceOutput); // // Take different actions depending on our environment: // 0: cruising // 1: collided // var sw = new Switch( new [] { new Connection(distanceToSpeed.Output, robot.SpeedInput), new Connection(new SineWave(0.5, 0.333, 0, updateFrequency: 10).Output, robot.DirectionInput), new Connection(new Constant(0).Output, robot.SpinInput), }, new[] { new Connection(new Constant(0.6).Output, robot.SpinInput), new Connection(new Constant(0).Output, robot.DirectionInput), new Connection(new Constant(0).Output, robot.SpeedInput), }); var collided = new Transform(distance => distance < 0.2 ? 1 : 0); collided.Input.ConnectTo(sharp.DistanceOutput); collided.Output.ConnectTo(sw.Input); // // Loop to keep us alive // for (; ;) { //Debug.Print ("TwoWheeled Tick"); Thread.Sleep(1000); } }
public static void Run() { var scope = new DebugScope(); // // Create the robot // var leftMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D3, Pins.GPIO_PIN_D1, Pins.GPIO_PIN_D2); leftMotor.CalibrationInput.Value = 1; var rightMotor = HBridgeMotor.CreateForNetduino(PWMChannels.PWM_PIN_D6, Pins.GPIO_PIN_D4, Pins.GPIO_PIN_D5); rightMotor.CalibrationInput.Value = 1; // // Create his eyes // var leftRange = new SharpGP2D12 { Name = "LeftRange" }; var rightRange = new SharpGP2D12 { Name = "RightRange" }; leftRange.AnalogInput.ConnectTo(new AnalogInputPin(AnalogChannels.ANALOG_PIN_A0, 10).Analog); rightRange.AnalogInput.ConnectTo(new AnalogInputPin(AnalogChannels.ANALOG_PIN_A1, 10).Analog); scope.ConnectTo(leftRange.DistanceOutput); scope.ConnectTo(rightRange.DistanceOutput); // // Now some intelligence // Each motor is driven by the distance sensor's reading // var nearDist = 0.1; var farDist = 0.5; var minSpeed = 0.4; TransformFunction distanceToSpeed = d => { if (d < nearDist) { return(-minSpeed); } if (d > farDist) { return(1); } var a = (d - nearDist) / (farDist - nearDist); return(a * (1 - minSpeed) + minSpeed); }; var leftSpeed = new Transform(distanceToSpeed); leftSpeed.Input.ConnectTo(leftRange.DistanceOutput); leftSpeed.Output.ConnectTo(leftMotor.SpeedInput); var rightSpeed = new Transform(distanceToSpeed); rightSpeed.Input.ConnectTo(rightRange.DistanceOutput); rightSpeed.Output.ConnectTo(rightMotor.SpeedInput); }