00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020
00021 #ifndef _CONTACT_KINEMATICS_POINT_PLANEWITHFRUSTUM_H_
00022 #define _CONTACT_KINEMATICS_POINT_PLANEWITHFRUSTUM_H_
00023
00024 #include "contact_kinematics.h"
00025
00026 namespace MBSim {
00027
00028 class Point;
00029 class PlaneWithFrustum;
00030
00036 class ContactKinematicsPointPlaneWithFrustum : public ContactKinematics {
00037 public:
00038 ContactKinematicsPointPlaneWithFrustum();
00039
00040
00041 virtual void assignContours(const std::vector<Contour*> &contour);
00042 virtual void updateg(fmatvec::Vec &g, ContourPointData* cpData, int index = 0);
00043 virtual void updatewb(fmatvec::Vec &wb, const fmatvec::Vec &g, ContourPointData* cpData) { throw MBSimError("(ContactKinematicsPointPlaneWithFrustum::updatewb): Not implemented!"); };
00044
00045
00046 private:
00050 int ipoint, iplane;
00051
00055 double rho, h;
00056 double rTop, rFrustumTop, rFrustumPlane, rPlane;
00057 fmatvec::Vec3 ET, EP, MT, MP;
00058 fmatvec::Vec3 nFrustum, tFrustum;
00059
00063 Point *point;
00064 PlaneWithFrustum *plane;
00065
00066 };
00067
00068 }
00069
00070 #endif
00071