this code is for inverted pendulum balancer. it is based on two-loop PID controller. One controller is for Angle and another one is for velocity.
Dependencies: HCSR04 L298HBridge mbed
Diff: stabilizer/stabilizer.h
- Revision:
- 0:489498e8dae5
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/stabilizer/stabilizer.h Fri Aug 25 21:10:23 2017 +0000 @@ -0,0 +1,27 @@ +////////////////////////////////////////////////////////////////////////////////// +// Company: edinburgh of university +// Engineer: ZEjun DU +// +// Create Date: 2017/08/20 13:06:52 +// Design Name: Inverted Pendulum Balancer +// Module Name: basic PID algorithm +// Tool Versions: “Keil 5” or “Mbed Complie Online” +// Description: this funcition is to control and manage the PID mode +// the main loop only need to invoke this module's funcition +// +////////////////////////////////////////////////////////////////////////////////// + +#ifndef STABILIZER_H +#define STABILIZER_H + +#include "mbed.h" +#include "L298HBridge.h" + +extern float M_Thr; +extern float M_Alt; +extern int PID_ctrl; +extern int Velocity_ctrl; + +void stabilize_task(void); + +#endif \ No newline at end of file