Commit for SWO for HW validation menu updates

git-svn-id: https://svn.vbchaos.nl/svn/hsb/trunk@245 05563f52-14a8-4384-a975-3d1654cca0fa
2017-10-10 12:46:41 +00:00
parent a73154a5e6
commit a688a6549a
19 changed files with 720 additions and 89 deletions
--- a/Code/HAL/inc/PID.h
+++ b/Code/HAL/inc/PID.h
@@ -0,0 +1,93 @@
+// -----------------------------------------------------------------------------
+/// @file  PID.h
+/// @brief File description
+// -----------------------------------------------------------------------------
+//  Micro-Key bv
+//  Industrieweg 28, 9804 TG Noordhorn
+//  Postbus 92, 9800 AB Zuidhorn
+//  The Netherlands
+//  Tel: +31 594 503020
+//  Fax: +31 594 505825
+//  Email: support@microkey.nl
+//  Web: www.microkey.nl
+// -----------------------------------------------------------------------------
+/// $Revision$
+/// $Author$
+/// $Date$
+//  (c) 2015 Micro-Key bv
+// -----------------------------------------------------------------------------
+
+/// @defgroup {group_name} {group_description}
+/// Description
+
+/// @file PID.h
+/// @ingroup {group_name}
+
+#ifndef INC_PID_H_
+#define INC_PID_H_
+
+
+// -----------------------------------------------------------------------------
+// Include files 
+// -----------------------------------------------------------------------------
+
+#include <stdbool.h>
+
+#include "stm32f10x.h"
+
+// -----------------------------------------------------------------------------
+// Constant and macro definitions 
+// -----------------------------------------------------------------------------
+
+
+
+// -----------------------------------------------------------------------------
+// Type definitions. 
+// -----------------------------------------------------------------------------
+
+struct Pid
+{
+   int Kp;                             // proportional constant
+   int Ki;                             // integration constant
+   int Kd;                             // differential constant
+   int input_d1;                       // Input t-1
+   bool initialized;
+};
+
+// -----------------------------------------------------------------------------
+// Function declarations 
+// -----------------------------------------------------------------------------
+
+/** ----------------------------------------------------------------------------
+ * PID_construct
+ * Constructor for a PID regulator
+ *
+ * @param	self                       PID object to construct
+ * @param	Kp                         proportional constant
+ * @param   Ki                         integration constant
+ * @param   Kd                         differential constant
+ *
+ * @return	ErrorStatus                SUCCESS if initialisation was successful
+ *                                     ERRROR otherwise
+ *
+ * @todo
+ * -----------------------------------------------------------------------------
+ */
+extern ErrorStatus PID_construct(struct Pid* self, int Kp, int Ki, int Kd);
+
+
+/** ----------------------------------------------------------------------------
+ * PID_calculate
+ * Calculate
+ *
+ * @param	self                       The PID object
+ * @param	error                      the error input to calculate
+ *
+ * @return	int                        calculated value
+ *
+ * @todo
+ * -----------------------------------------------------------------------------
+ */
+extern int PID_calculate(struct Pid* self, int error);
+
+#endif /* INC_PID_H_ */