Dual-Sensor Proportional-Integral-Derivative Line-Follower Algorithm for Lego Mindstorms EV3

Hello World!

Here's how to use this:

1. Download and extract the files from this repository, or clone this using $ git clone git://github.com/aryan-02/2sensorpid.git
2. Before you import the My-Blocks, open the project properties, click "Variables" and create the following variables:
   
   

   Variable Name	DataType
   Error	Numeric
   Integral	Numeric
   Derivative	Numeric
   kP	Numeric
   kI	Numeric
   kD	Numeric
   l_Error	Numeric

3. Import both the My-Blocks (init and PID).
4. Right after the start block, put the init my-block.
5. Now, put the PID my-block inside a loop. Add two Color Sensor blocks with mode set to Measure -> Reflected Light Intensity, set the ports for your left and right color sensors respectively. Now, plug in the left and right sensor values into their respective input slots (leftSensorValue and rightSensorValue).
6. Next, Set your power, kP, kI and kD. Make sure your left motor is connected to port A and the right motor is connected to port B.

And you're done.

More information

This algorithm can easily be extended to any even number of color sensors, so you can go crazy with it! For example, for four sensors, say your sensors are numbered 0, 1, 2, 3 from left to right. Let us denote the reflected light intensity as measured by the ith sensor as sensor(i) Then, for the left sensor value, pass the value measured by (sensor[0] * 2 + sensor[1] * 1) and the right sensor value as (sensor[2] * 1 + sensor[3] * 2)

Here's how to contribute to this repository:

Fork the repository, make the changes. Make sure you commit your changes and mention what you've improved. Then make a pull request. If the changes are approved, they'll get merged into this repository.