Файл: Advanced Robotics with the Toddler (Paralax, student guide, v1.3, 2004).pdf

Chapter #7: Staying on the Table · Page 151

The Toddler will also attempt to walk along the edge of the table although this is not explicitly built into the program. In theory, if the Toddler walks perpendicular to the edge it will walk to the edge, back up, walk forward and repeat this indefinitely. In practice, this does not occur for two reasons. The first is that the Toddler’s movement is not perfectly repeatable. As it moves forward and backwards, the Toddler turns slightly to the one side or the other. Eventually the IR sensors will detect the difference and the Toddler will turn instead of backing up or moving forward.

The sensors themselves are another area that will cause the Toddler to turn parallel to the edge of the table. This will occur if one sensor is more sensitive than the other. Of course, this difference will work in one direction and may cause the Toddler to take an extra step forward if the detection is handled by the other side. This will not cause the Toddler to walk off the table though since it tries to stay so far away from the edge. An extra step or two will not cause a problem.

One area that can be a problem especially when the IR LEDs and sensors are pointed forward is that the Toddler will have limited peripheral vision. It is possible for the Toddler to turn parallel to an edge and drift towards the edge. In theory, the sensor on that side should detect the edge and the Toddler will turn away from the edge. This problem occurs more often when the edge of the table is irregular. Aiming the IR LEDs and sensors outward slightly can help eliminate the problem if it occurs.

ACTIVITY #3: TODDLER SHADOW WALKER

For one Toddler to follow another, the Toddler that follows, a.k.a. the shadow walker, has to know how far the lead Toddler is ahead. If the shadow Toddler is lagging behind, it has to detect this and speed up. If the shadow Toddler is too close to the lead Toddler, it has to detect this as well and slow down. If it’s the right distance, it can wait until the measurements indicate it’s too far or too close again.

Unlike the Toddler’s sibling the Boe-Bot, the Toddler moves in discrete steps, not small increments using wheels. Whereas the Boe-Bot uses calculated proportional control, the Toddler must be a bit more discrete. It is possible to take proportional steps but the accuracy of the Toddler’s movements minimizes the effect of minor changes to movements. On the other hand, the Boe-Bot can move one or both of its wheels a fraction of an inch in subsecond times. A Toddler step can take as long as a second.

As it turns out, the Toddler’s IR range finders work well for tracking another Toddler. The range results are in discrete values and the number is not large. If it were, then the

Page 152 · Advanced Robotics with the Toddler

values would have to be converted down to this level of gradation that is manageable. It is then simply a matter of choosing the appropriate step type and magnitude.

The Toddler is a difficult target for another Toddler to locate with its many facets. To improve the detection using the IR sensors, the target Toddler should have a white box placed around it. This can be made of paper or cardboard and it can be affixed to the Toddler’s frame using tape or other means. The box should start about where the base of the Toddler’s central body contains the servos and can extend to just above the circuit board. The IR sensors can be angled down slightly so they will detect the central portion of the box at a distance of about a foot. The box should not impede the foot movement or the servos and it can extend out from the Toddler by as much as a few inches. It should not be too heavy or large so as to significantly change the center of gravity forcing adjustments in walking behavior.

Although these changes are not absolutely required for one Toddler to follow another, they will improve the overall system performance. Also, the roaming area needs to be free of obstacles and walls otherwise the Toddler that will be following may detect these obstacles instead. There is no checking in the program to determine if the object detected is remaining stationary although it is possible to modify the program to do so.

Programming the Toddler Shadow Walker

Program Listing 7.3 uses additional branch and lookup statements to adjust the Toddler’s position based on the range finder results. The movements are designed to aim the Toddler at the object it is following, usually another Toddler, and to keep that object at a discrete distance.

Chapter #7: Staying on the Table · Page 153

Your Turn

√Run Program Listing 7.3.

√Point the Toddler at an 8 ½ x 11” sheet of paper held in front of it as though it’s a wall-obstacle. The Toddler should move about trying to maintain an average distance from the object.

√Try moving the paper so it rotates about the Toddler. The Toddler should rotate with it.

√Try using the sheet of paper to lead the Toddler around. The Toddler should follow it.

'-----[ Title ]-----------------------------------------------------------

'Toddler Program 7.3: Shadow Walker

'Follows another Toddler with a piece of paper on his backside

'{$STAMP BS2}

'{$PBASIC 2.5}

'-----[ I/O Definitions ]-------------------------------------------------

'-----[ Movement Support Codes ]------------------------------------------

'The following state tables are lists of movement state numbers.

'A xx indicates the end of a list.

'These are used with the Movement routine.

' -----[ EEPROM Data ]-----------------------------------------------------

'

' ------ Movement Value Tables ------

' These can be used with the Movement routine. ' The tables can contain Basic Movement Codes.

'

'------ Basic Movement Codes ------

'Used in Movement tables.

'Referenced below using LOOKUP statement.

'------ Basic Movement Tables ------

'These tables can contain Movement Support Codes.

Page 156 · Advanced Robotics with the Toddler

'The constant syntax is lxry where x and y indicate the range from the

'left and right sensor respectively. A zero value indicates nothing

'is within range while a 5 indicates an object is within inches.

'In general, a 3 will be the closest desirable distance.