__ses_ui_r()

diff --git a/ses_core.h b/ses_core.h
index 62c16d1755cec8734a6838f8dab8cd441a2d2a33..5e1d709cc90cbc07eaf9d06446d0fba3ab78c159 100644 (file)
--- a/ses_core.h
+++ b/ses_core.h
@@ -36,6 +36,12 @@ struct ses_path_s
        double         r;
        double         jr;
 
+       double         v;
+       double         jv;
+
+       double         a;
+       double         ja;
+
        int            type;
        int            index;
 };

diff --git a/ses_step_va.c b/ses_step_va.c
index 8d4577df95ae19243d8953abe8eb0689d1648341..29b95d515d9e9f7a3863f8f2833a981c129462ad 100644 (file)
--- a/ses_step_va.c
+++ b/ses_step_va.c
@@ -10,6 +10,14 @@ static inline void __ses_ur_i(double* a, double* ja, double v, double jv, double
        *ja = (jv * r -  v * jr) / R;
 }
 
+static inline void __ses_ui_r(double* r, double* jr, double v, double jv, double a, double ja)
+{
+       double R  = a * a + ja * ja;
+
+       *r  = ( v * a + jv * ja) / R;
+       *jr = (jv * a -  v * ja) / R;
+}
+
 static inline void __ses_ir_u(double* v, double* jv, double a, double ja, double r, double jr)
 {
        *v  =  a * r  - ja * jr;