Bayley Wang / Mbed 2 deprecated foc-ed_in_the_bot_compact

Dependencies:   FastPWM3 mbed

Revision:
39:80b38a8e1787
Parent:
38:07cb4ae6c1bd
diff -r 07cb4ae6c1bd -r 80b38a8e1787 Optimize/Optimize.cpp
--- a/Optimize/Optimize.cpp	Tue Nov 29 00:31:18 2016 +0000
+++ b/Optimize/Optimize.cpp	Sat Dec 03 17:49:02 2016 +0000
@@ -34,6 +34,10 @@
     *q = sqrtf(is * is - *d * *d);
 }
 
+float get_vs2(float w, float d, float q) {
+    return w * w * (Lq * Lq * q * q + (Ld * d + FLUX_LINKAGE) * (Ld * d + FLUX_LINKAGE));
+}
+
 float val_alpha(float tau, float tau2) {
     float tau23 = acbrt(tau2);
     if (tau < TAU0) {