Description
This is a programming assignment. Given a robot equipped with 6 Infrared sensors as shown in the picture below (θ1=45o, θ2 = 30o, θ3= -30o, θ4=-45o. θ5= -130o, θ6=130o), write a C++ program that computes the magnitude of drive and direction of turn of the robot movement based on sensor readings.
The sensor readings for three consecutive time steps are given in a data file: readings.dat. (You may download the data file from the course page). For each set of 6 sensor readings, your program should output the turn direction and magnitude in the form: the robot should turn -25 degrees with a magnitude of 0.35).
Use linear magnitude profile for the potential fields implemented for the motor schema.
MAX_DISTANCE of the sensor is set to D =10 cm.
Name your program pfield.cpp. Your program should include comments for logically related code segments. It should also have program heading at the beginning of the program which includes information such as the name of the programmer, due date, description of this program.
Programming requirements:
- Your program reads the data from a data file named “readings.dat” • The program should include at least these 3 functions:
o The main function handles the main program logic: 1. loop til the end of the data file is reached
1.1 loop over the 6 sensors:
1.1.1 SENSE: get sensor information for the
1.1.2 ACT: use repulsive potential field to generate the vector for movement
1.1.3 Add the vector onto the overall sum-of-vectors
1.2 Report direction of movement for the current readings
o A function implements the repulsive potential field o A function that adds two vectors
1
To submit your program, log onto D2L, go to the course page, and submit the program to the Dropbox named “Homework 3”. You may submit multiple times before the due time. All versions of the programs will be kept in your account
readings.dat content:
5 25 20 28 25 2
5 6 4 8 28 25
4 5 20 28 8 12
2
