Scribd
Upload
23 views7 pages

Pretest Week 7

The document is a pretest that contains questions about PID control systems and motor speed control. It includes: 1) An explanation of PID control systems and their use of feedback to control instrument precision. 2) A block diagram of a motor speed control system using a PID controller. 3) C code for a PID controlled motor with position and velocity calculations, target setting, control signal determination, and motor direction and speed output.

Uploaded by

Anshal Abhinaya
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
23 views7 pages

Pretest Week 7

The document is a pretest that contains questions about PID control systems and motor speed control. It includes: 1) An explanation of PID control systems and their use of feedback to control instrument precision. 2) A block diagram of a motor speed control system using a PID controller. 3) C code for a PID controlled motor with position and velocity calculations, target setting, control signal determination, and motor direction and speed output.

Uploaded by

Anshal Abhinaya
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
You are on page 1/ 7

PRETEST WEEK 7

Nama : Anshal Abhinaya

NIM : 162012433014

1. Jelaskan Kendali PID yang Anda ketahui!

2. Buat Block diagram sistem kendali kecepatan Motor dengan menggunakan PID kontroller!

3. Tuliskan PID kontrol tersebut dalam bahasa C!

JAWAB

1. Sistem kontrol PID (Proportional Integral Derivative) merupakan kontroler untuk


menentukan presisi suatu sistem instrumentasi dengan karakteristik adanya umpan balik
(feedback) pada sistem tesebut
2.

#include <util/atomic.h>

// Pins

#define ENCA 2

#define ENCB 3

#define PWM 5

#define IN1 6

#define IN2 7
// globals

long prevT = 0;

int posPrev = 0;

// Use the "volatile" directive for variables

// used in an interrupt

volatile int pos_i = 0;

volatile float velocity_i = 0;

volatile long prevT_i = 0;

float v1Filt = 0;

float v1Prev = 0;

float v2Filt = 0;

float v2Prev = 0;

float eintegral = 0;

void setup() {

Serial.begin(115200);

pinMode(ENCA,INPUT);

pinMode(ENCB,INPUT);

pinMode(PWM,OUTPUT);

pinMode(IN1,OUTPUT);
pinMode(IN2,OUTPUT);

attachInterrupt(digitalPinToInterrupt(ENCA),

readEncoder,RISING);

void loop() {

// read the position in an atomic block

// to avoid potential misreads

int pos = 0;

float velocity2 = 0;

ATOMIC_BLOCK(ATOMIC_RESTORESTATE){

pos = pos_i;

velocity2 = velocity_i;

// Compute velocity with method 1

long currT = micros();

float deltaT = ((float) (currT-prevT))/1.0e6;

float velocity1 = (pos - posPrev)/deltaT;

posPrev = pos;

prevT = currT;
// Convert count/s to RPM

float v1 = velocity1/600.0*60.0;

float v2 = velocity2/600.0*60.0;

// Low-pass filter (25 Hz cutoff)

v1Filt = 0.854*v1Filt + 0.0728*v1 + 0.0728*v1Prev;

v1Prev = v1;

v2Filt = 0.854*v2Filt + 0.0728*v2 + 0.0728*v2Prev;

v2Prev = v2;

// Set a target

float vt = 100*(sin(currT/1e6)>0);

// Compute the control signal u

float kp = 5;

float ki = 10;

float e = vt-v1Filt;

eintegral = eintegral + e*deltaT;

float u = kp*e + ki*eintegral;

// Set the motor speed and direction


int dir = 1;

if (u<0){

dir = -1;

int pwr = (int) fabs(u);

if(pwr > 255){

pwr = 255;

setMotor(dir,pwr,PWM,IN1,IN2);

Serial.print(vt);

Serial.print(" ");

Serial.print(v1Filt);

Serial.println();

delay(1);

void setMotor(int dir, int pwmVal, int pwm, int in1, int in2){

analogWrite(pwm,pwmVal); // Motor speed

if(dir == 1){

// Turn one way

digitalWrite(in1,HIGH);

digitalWrite(in2,LOW);
}

else if(dir == -1){

// Turn the other way

digitalWrite(in1,LOW);

digitalWrite(in2,HIGH);

else{

// Or dont turn

digitalWrite(in1,LOW);

digitalWrite(in2,LOW);

void readEncoder(){

// Read encoder B when ENCA rises

int b = digitalRead(ENCB);

int increment = 0;

if(b>0){

// If B is high, increment forward

increment = 1;

else{

// Otherwise, increment backward


increment = -1;

pos_i = pos_i + increment;

// Compute velocity with method 2

long currT = micros();

float deltaT = ((float) (currT - prevT_i))/1.0e6;

velocity_i = increment/deltaT;

prevT_i = currT;

You might also like