What is the right approach to write the spin controller for a soccer robot?

Question

Imagine programming a 3 wheel soccer robot. What type of controller would you use for spinning it? P? PID?

The goal for this controller is that it should make the robot stand in a defined angle ( 0 degree ) and turn back if rotated by hand or other robot.

I use stepper motors for my robot and not servos so I need to implement this in my software!

I have written a sample P type controller already and the movement is fairly good. But I would like to make it better if possible. The code is as follows:

void spinSpeed(int devidedValue, int addedValue, int correction) {

    if(degree<correction && degree>-correction) {
        motorSpeed = 0;
    } else {
        if(degree > 0) {
            motorSpeed = ((degree)/(devidedValue) + (addedValue));
        } else {
            motorSpeed = ((degree)/(devidedValue) - (addedValue));  
        }
    }
}

correction is a range , in which robot has no movement. degree is a number between -127 and 128 which is returned from the compass. motorSpeed is a number between 0 and 255 which is applied to the PWM.

Presumably this routine is run every time the compas generates a new value for degree? — Mark Booth, Oct 23 '12 at 19:50
@MarkBooth I have my code in a while(1) so in every cycle it gets the value from the compass gives it to the function and then applies the result to the motors. — Miro Markaravanes, Oct 23 '12 at 19:56
I'd investigate what kind of controller that a servo uses, since you are trying to duplicate servo behavior in software. — Chris Laplante, Oct 23 '12 at 20:03
I don't use servos. I use step motors so there isn't already such a behavior in the motor. — Miro Markaravanes, Oct 23 '12 at 20:06
Hi Miro, on stack exchange it is better to edit your question in response to questions in comments, that way the comments can be tidied up (deleted) so that they don't distract from the question itself. — Mark Booth, Oct 23 '12 at 20:46
@MiroMarkarian: I know, but you are looking for a similar algorithm that servos use — Chris Laplante, Oct 23 '12 at 21:01
Please clarify: 1) at the definition of the goal, "turn back" means turn "backwards" (to 180 degrees), or to re-align itself to 0 degrees? 2) What does it mean to "rotate by hand", an RC command or an outside person rotating the robot by hand? The robot player would not know if it was turned by a person or another robot (unless there are other sensors to know so), maybe just its heading sensor is giving wrong data... — Gürkan Çetin, Jun 28 '15 at 07:19
just noticed now that this question is probably an earlier version of the several other similar questions. — Gürkan Çetin, Jun 28 '15 at 07:23
@GürkanÇetin This is actually the very first question on this site! 1. I meant back to a pre-defined reference point that we have agreed to call 0 degrees. It might be in any direction. 2. The source of the error is irrelevant to the correction. All that the system is concerned about is the presence of a deviation from the reference point that needs to be corrected. — Miro Markaravanes, Jun 29 '15 at 10:38

score 8 · Answer 1 · answered Oct 23 '12 at 20:10

A PID controller would be the best, Using a compass then it is a relatively straight forward task of getting the bearing of your robot and comparing it to the bearing you want to achieve, and using some PID tuning techniques to achieve a smooth turning motion to your desired heading. This approach can also be applied to rotating by a given amount accurately.

I have already done some robotics in this field, this is what we used in our robot, doing a not too dissimilar task to yours...

Thanks for your answer. I wanted to accept the answer but I would like to see more answers, so I will accept when there were more answers ;) — Miro Markaravanes, Oct 23 '12 at 20:13

Mark Booth · Accepted Answer · 2012-11-06T20:30:34.777

The important thing to remember about a PID control loop is that each term is intended to dominate control at different times during a move.

The proportional term is intended to dominate and provide a larger torque (or in your case speed) the further you are away from your target position.

The derivative term is intended to dominate during the 'cruise' phase of your typical trapezoidal move. It helps to reign back a very high proportional term and limit runaway acceleration when you are far from your destination, but it can also help increase the speed at which you converge on your destination when you get close to it and the proportional term contributes much less.

If you are using a velocity controller rather than a torque controller then the derivative term may actually be hidden inside your speed controller and not directly accessible to your PID loop. This can make control simpler (typically it will just accelerate as quickly as it can up to the desired speed or maximum speed, whichever is lower) but it can also make it less predictable. Often an overly aggressive D (or P) term can result in getting into a limit cycle (often incorrectly called resonance or oscillation due to the sound of the motors humming or even screaming in this state, though limit-cycle is a much more accurate description).

The integral term is there to correct for residual steady-state error, that is where there is a persistent, long term difference between where you are being asked to go and where you actually are. Your current correction (really just tolerance) value works like the opposite of an integral term, it cuts the motor entirely when you are within a deadband around the desired position.

Due to these factors, you will gain little from implementing a full PID loop unless you also plan in a velocity profile with a distinct accelerate, cruise & decelerate phases.

Also bear in mind that the deadband and lack of I term will mean that the final position will always be somewhat random and will most likely differ depending on which direction you approach the desired position. As such, your bi-directional repeatability could be much worse than your standard repeatability.

For more information on the difference between accuracy, repeatability and resolution, see this excellent description. In your case, your resolution is your compass sensor, while both accuracy, repeatability are most likely limited by your correction value, since if the correction value is larger than your compass resolution, you are throwing away some of your positional accuracy in return for being able to turn off your motor when you are close.

What is the right approach to write the spin controller for a soccer robot?

2 Answers2

Linked