LEGO NXT Robot Programming Introduction to Programming a

LEGO NXT Robot Programming Introduction to Programming a Lego NXT robot in C#

Objectives Introduction to the NXT Robot Hardware/Software Requirements Setting up a Bluetooth connection Connecting to a robot from a C# application Getting the robot to move Obtaining information from sensors • • • – – – Touch Ultrasonic Light

The NXT Tribot Robot Sound Ultrasonic Touch Wheels (x 2) Grabber Light

Software/Hardware Requirements • Hardware – NXT Mindstorms Lego robot – Bluetooth adapter (USB) • Software – Lego NXT Driver software (CD provided with robot) – Visual Studio (C#) – Mind. Squalls API http: //www. mindsqualls. net/

Setting up a Bluetooth connection • On the NXT robot – Ensure bluetooth is switched on – Ensure it is “visible” • On the PC – Add a “new” bluetooth device – Attach it to your NXT (should be discovered automatically) • Passcode will be required on both the NXT and the PC • Need to record which COM port is being used • For detailed instructions see the document Connecting NXT via Bluetooth. docx

Preparing a C# project • Create a new forms project • Add the Mind. Squalls library to the project – Right click the project (in the solution explorer) and select “Add” – Choose “Existing item” – Browse for NKH. Mind. Squalls. dll and press “Add” • Add a reference to this library – Right click references (in the solution explorer) and select “Add Reference” – Select the “Browse” tab – Select the file NKH. Mind. Squalls. dll and press “OK” • Add the following line to the top of the form code using NKH. Mind. Squalls;

Connecting to the robot • The robot is controlled via an object of the class Nxt. Brick • When a brick object is created it needs to be passed a string parameter containing the COM port for the bluetooth connection • The brick object must then be connected: Nxt. Brick brick = new Nxt. Brick(s. Com. Port); brick. Connect();

Disconnecting the robot • Before closing the application the brick should be disconnected • The brick object should also be deleted brick. Disconnect(); brick = null; • To check if a robot is connected or not if (brick != null && brick. Is. Connected)

“Talking” to the Nxt. Brick • Status and other information can be obtained from the Nxt. Brick via properties brick. Name brick. Battery. Level • Sounds can be sent to the Nxt. Brick (1 st param is frequency, 2 nd param is time in milliseconds) brick. Play. Tone(500, 250); Thread. Sleep(250); // pause to allow tone to play brick. Play. Tone(1000, 500); • Note that if you are using the Thread. Sleep method you need to add the following at the top of your code: using System. Threading;

Demonstration Hello. NXT. sln

NXT Tribot Ports • 3 Motors – Motor. A: Right wheel – Motor. B: Grabber – Motor. C: Left wheel • 4 Sensor Ports – Sensor 1: Touch sensor – Sensor 2: Light sensor – Sensor 3: Sound sensor – Sensor 4: Ultrasonic sensor

Getting the robot to move • Create Motor objects and attach to motor ports brick. Motor. A = new Nxt. Motor(); brick. Motor. C = new Nxt. Motor(); • Motors can be set to run at a power level (speed) for a particular number of degrees rotation brick. Motor. A. Run(20, 360); brick. Motor. C. Run(20, 360); • • Power values range from 0 -100 (% power of motor) Rotation values range from 0 -unlimited (0 runs continuously) To turn run one motor only (or both at different speeds) To reverse set use a negative power value

Stopping the robot • If the motors are set to run continuously then your code must provide the instruction to stop • The robot can be stopped by setting the motors into “idle” mode brick. Motor. A. Idle(); brick. Motor. C. Idle(); • Another option is to “brake” the motors but in this case power is still used to hold the motor in position (e. g. On a hill)

Sequencing issues • The C# code runs sequentially, issuing instructions to the robot as specified • If an instruction tells the robot to do something which will take some time then the code does not wait for that operation to complete • What will happen if the following code is used? brick. Motor. A. Run(20, 3600); brick. Motor. C. Run(20, 3600); brick. Motor. A. Run(-20, 3600); brick. Motor. C. Run(-20, 3600);

Solving the problem • There a number of ways to solve sequencing problems • Ideally you would obtain information from the robot to indicate when it is finished • This can be quite complicated • A crude but simple approach is to add code to make the program “sleep” for enough seconds to let the robot complete its operation brick. Motor. A. Run(20, 3600); brick. Motor. C. Run(20, 3600); Thread. Sleep(5000); //sleep for 5 seconds brick. Motor. A. Run(-20, 3600); brick. Motor. C. Run(-20, 3600);

Synchronising the motors • Setting both motors to run separately will inevitably affect the straightness of motion • One motor will start fractionally before the other (depending on the order of code statements) • This will cause the robot to start with a slight turn (and finish with a turn in the opposite direction) • This can be avoided by creating a synchronised pair of motors and controlling them as a pair

Controlling synchronised motors • Create an NXTSync. Motor object from the required motors Nxt. Motor. Sync motor. Pair; motor. Pair = new Nxt. Motor. Sync(brick. Motor. A, brick. Motor. C); • To run the motors as a pair use: motor. Pair. Run(20, 180, 0); • This time a third parameter is required to control turning. It ranges from -100 to 100 (0 moves straight) • As before an angle of 0 moves the robot continuously • To stop both motors use motor. Pair. Idle();

Controlling the Tribot grabber • The grabber on the Tribot robot is controlled by a motor • Running the motor in the forward direction opens the grabber brick. Motor. B. Run(5, 45); • Running the motor in the backward direction closes the grabber brick. Motor. B. Run((sbyte)(-5), 45); • A cast is required here to ensure the correct data type is used • Note that only small angles of rotation are required. Turn too far and your grabbers will fall off the robot!!

Demonstration NXTMove. sln

Interacting with sensors • Objects can be created for each sensor type and attached to the appropriate port • A poll command is issued to the sensor and this enables data recorded by the sensor to be returned • Appropriate methods exist (depending on the sensor type) to retrieve this data • A timer control on your form can be used to repeatedly poll and retrieve data • The timer tick event can then be used to perform necessary actions depending on the data retrieved

The touch sensor • Creating and attaching a touch sensor (should be done before connecting the brick): touch. Sensor = new Nxt. Touch. Sensor(); brick. Sensor 1 = touch. Sensor; • Determining whether the touch sensor is pressed or not: touch. Sensor. Poll(); if (touch. Sensor. Is. Pressed == true) { // code to excecute if sensor is pressed }

Demonstration Touch. Test. sln

The light sensor (not NXT 2) • Creating and attaching a light sensor (should be done before connecting the brick): light. Sensor = new Nxt. Light. Sensor(); brick. Sensor 2 = light. Sensor; • Determining the intensity of light recorded by the sensor: light. Sensor. Poll(); int i. Intensity = (int)light. Sensor. Intensity; • The light sensor can generate a light of its own which reflects objects and makes recording more accurate: light. Sensor. Generate. Light = true;

Demonstration Light. Test. sln

The sound sensor (not NXT 2) • Creating and attaching a sound sensor (should be done before connecting the brick): sound. Sensor = new Nxt. Sound. Sensor(); brick. Sensor 3 = sound. Sensor; • Determining the level of sound recorded by the sensor: sound. Sensor. Poll(); int i. Sound = (int)sound. Sensor. Sound. Level; • Note that this sensor records only sound levels, it cannot be used to determine the frequency of the sound (i. e. It cannot be used for sound recognition)

Demonstration Sound. Test. sln

The ultrasonic sensor • Sends out an ultrasonic wave which is deflected by an object in front of the sensor • The time to return enables the distance to be calculated • Creating and attaching an ultrasonic sensor (should be done before connecting the brick): ultrasonic. Sensor = new Nxt. Ultrasonic. Sensor(); brick. Sensor 4 = ultrasonic. Sensor; • Determining the distance (in cm) recorded by the sensor: ultrasonic. Sensor. Poll(); int i. Dist = (int) ultrasonic. Sensor. Distance. Cm; • If there is no object in range a distance value of 255 is returned

Demonstration Ultrasonic. Test. sln