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

Revision:
0:489498e8dae5
diff -r 000000000000 -r 489498e8dae5 stabilizer/stabilizer.h
--- /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