00001
00002
00003
00004
00005
00006 #include "cms.hh"
00007 #include "posemath.h"
00008
00009
00010 CMS_STATUS
00011 CMS::update (PM_CARTESIAN & Cart)
00012 {
00013 update (Cart.x);
00014 update (Cart.y);
00015 update (Cart.z);
00016 return (status);
00017 }
00018
00019 CMS_STATUS
00020 CMS::update (PM_CARTESIAN * x, int n)
00021 {
00022 int i;
00023 for (i = 0; i < n; i++)
00024 {
00025 update (x[i]);
00026 }
00027 return (status);
00028 }
00029
00030 CMS_STATUS
00031 CMS::update (PM_SPHERICAL & Sph)
00032 {
00033 update (Sph.theta);
00034 update (Sph.phi);
00035 update (Sph.r);
00036 return (status);
00037 }
00038
00039 CMS_STATUS
00040 CMS::update (PM_SPHERICAL * x, int n)
00041 {
00042 int i;
00043 for (i = 0; i < n; i++)
00044 {
00045 update (x[i]);
00046 }
00047 return (status);
00048 }
00049
00050 CMS_STATUS
00051 CMS::update (PM_CYLINDRICAL & Cyl)
00052 {
00053 update (Cyl.theta);
00054 update (Cyl.r);
00055 update (Cyl.z);
00056 return (status);
00057 }
00058
00059 CMS_STATUS
00060 CMS::update (PM_CYLINDRICAL * x, int n)
00061 {
00062 int i;
00063 for (i = 0; i < n; i++)
00064 {
00065 update (x[i]);
00066 }
00067 return (status);
00068 }
00069
00070
00071 CMS_STATUS
00072 CMS::update (PM_ROTATION_VECTOR & Rot)
00073 {
00074 update (Rot.s);
00075 update (Rot.x);
00076 update (Rot.y);
00077 update (Rot.z);
00078 return (status);
00079 }
00080
00081 CMS_STATUS
00082 CMS::update (PM_ROTATION_VECTOR * x, int n)
00083 {
00084 int i;
00085 for (i = 0; i < n; i++)
00086 {
00087 update (x[i]);
00088 }
00089 return (status);
00090 }
00091
00092
00093
00094 CMS_STATUS
00095 CMS::update (PM_ROTATION_MATRIX & Mat)
00096 {
00097 update (Mat.x);
00098 update (Mat.y);
00099 update (Mat.z);
00100 return (status);
00101 }
00102
00103 CMS_STATUS
00104 CMS::update (PM_ROTATION_MATRIX * x, int n)
00105 {
00106 int i;
00107 for (i = 0; i < n; i++)
00108 {
00109 update (x[i]);
00110 }
00111 return (status);
00112 }
00113
00114 CMS_STATUS
00115 CMS::update (PM_QUATERNION & Quat)
00116 {
00117 update (Quat.s);
00118 update (Quat.x);
00119 update (Quat.y);
00120 update (Quat.z);
00121 return (status);
00122 }
00123
00124 CMS_STATUS
00125 CMS::update (PM_QUATERNION * x, int n)
00126 {
00127 int i;
00128 for (i = 0; i < n; i++)
00129 {
00130 update (x[i]);
00131 }
00132 return (status);
00133 }
00134
00135
00136 CMS_STATUS
00137 CMS::update (PM_EULER_ZYZ & Zyz)
00138 {
00139 update (Zyz.z);
00140 update (Zyz.y);
00141 update (Zyz.zp);
00142 return (status);
00143 }
00144
00145 CMS_STATUS
00146 CMS::update (PM_EULER_ZYZ * x, int n)
00147 {
00148 int i;
00149 for (i = 0; i < n; i++)
00150 {
00151 update (x[i]);
00152 }
00153 return (status);
00154 }
00155
00156
00157 CMS_STATUS
00158 CMS::update (PM_EULER_ZYX & Zyx)
00159 {
00160 update (Zyx.z);
00161 update (Zyx.y);
00162 update (Zyx.x);
00163 return (status);
00164 }
00165
00166 CMS_STATUS
00167 CMS::update (PM_EULER_ZYX * x, int n)
00168 {
00169 int i;
00170 for (i = 0; i < n; i++)
00171 {
00172 update (x[i]);
00173 }
00174 return (status);
00175 }
00176
00177 CMS_STATUS
00178 CMS::update (PM_RPY & Rpy)
00179 {
00180 update (Rpy.r);
00181 update (Rpy.p);
00182 update (Rpy.y);
00183 return (status);
00184 }
00185
00186 CMS_STATUS
00187 CMS::update (PM_RPY * x, int n)
00188 {
00189 int i;
00190 for (i = 0; i < n; i++)
00191 {
00192 update (x[i]);
00193 }
00194 return (status);
00195 }
00196
00197
00198 CMS_STATUS
00199 CMS::update (PM_POSE & Pose)
00200 {
00201 update (Pose.tran);
00202 update (Pose.rot);
00203 return (status);
00204 }
00205
00206 CMS_STATUS
00207 CMS::update (PM_POSE * x, int n)
00208 {
00209 int i;
00210 for (i = 0; i < n; i++)
00211 {
00212 update (x[i]);
00213 }
00214 return (status);
00215 }
00216
00217
00218 CMS_STATUS
00219 CMS::update (PM_HOMOGENEOUS & Hom)
00220 {
00221 update (Hom.tran);
00222 update (Hom.rot);
00223 return (status);
00224 }
00225
00226 CMS_STATUS
00227 CMS::update (PM_HOMOGENEOUS * x, int n)
00228 {
00229 int i;
00230 for (i = 0; i < n; i++)
00231 {
00232 update (x[i]);
00233 }
00234 return (status);
00235 }