From ccecb3a1b0ac7db267988c17c1bac5b0006d7614 Mon Sep 17 00:00:00 2001
From: bloeys <bloeys@outlook.com>
Date: Mon, 17 Jan 2022 20:33:36 +0400
Subject: [PATCH] Simulate and fetch results

---
 main.go                |   8 ++++-
 pgo/libs/libphysx-c.a  | Bin 8944 -> 9384 bytes
 pgo/pgo.go             |  75 +++++++++++++++++++++++++++++++++++++++--
 pgo/physx-c/CPxScene.h |   2 ++
 4 files changed, 82 insertions(+), 3 deletions(-)

diff --git a/main.go b/main.go
index 7819393..aed5a75 100755
--- a/main.go
+++ b/main.go
@@ -33,8 +33,14 @@ func main() {
 	scenePvdClient.SetScenePvdFlag(pgo.PvdSceneFlag_eTRANSMIT_CONTACTS, true)
 	scenePvdClient.SetScenePvdFlag(pgo.PvdSceneFlag_eTRANSMIT_SCENEQUERIES, true)
 
-	for {
+	pMat := p.CreateMaterial(0.5, 0.5, 0.6)
+	groundPlane := pgo.CreatePlane(p, pgo.NewPlane(0, 1, 0, 1), pMat)
+	s.AddActor(groundPlane.ToActor())
 
+	for {
+		s.Simulate(1 / 60.0)
+		a, b := s.FetchResults(true)
+		println("a:", a, "; b:", b)
 	}
 
 	p.Release()
diff --git a/pgo/libs/libphysx-c.a b/pgo/libs/libphysx-c.a
index cac0d89ef1fbacd6987439e31fe469097bb2becd..e75609bc8cfaf4d90244de00e60d8de2bd45ea2a 100755
GIT binary patch
delta 1033
zcmbW#OH30{6b9g*+7{XZEqy<x?Mz!RF+vE0*p>2#8eAX<QB0I7bqFNIG#0cbCM1Ng
zBEfjqvM?;%pqM7Olte;Yq2j`oycULyh8+nD;y<0*2uquMJu~;7JNM2xb8z`}_w(db
zOY?<hx%j(h1#lH`tN_j(!0iP**^(_r@=uo>Gis`IK{KH74(Nh;-jmd+iyZ-)$V`c!
zk$h7N{3B^u7j6KG78xlptBV|P0r^^V3iCDcx-J&s1|$#alqBaVHm8e@07ZL@6d%?#
z#W#3Cp-o+IpC_l#kj}ftH=;zlMp&!c#P7O5;Z=pl*gv99q(^V4xyj5#4yn}GcsAA5
zo9|Dn57pF(x$<akY<x0ve?mQ-T^<*9yHfaUx^7@&lI6zKvok9WV8_YBxPhz(*rI8c
z@R+K|90Uf~vOHs_1RTYH8CJwk3qD|(V+~<ok!AzH0moakaRpeHSzYE2GA4OH7sC`r
zqQD*v$AJyn3<3Lm_z>e7H)>B5KNlEbf)xpP;XoD4sDv99*bqY;3aU{DCtR?j79NBV
zK@fg~;6nfsY7m8tdQ`x0>N#!y^`JtBWzbOlZ|%jrtx>!&S!&89zVb*_#aFYd@XdDj
z%*kBYeo4GESt?7pg<JMd4v`ADl-9RPA6Xxs*@$v8Pi(Ur?Xz8bpV>XjtRRfsRuZ@6
zK4)#m_f=M$Z~S+qSPgZHcTtzrZ#e&pO<)=RPVu`bZ7tfRi$e0cEy<pxLv4LnD2i&C
z@A|OKULzvrm6YYq<J>m8il{hL(zbKq7hkk9%G~{j*(aXGdJ}TW^^-kjAB^ZxpYZ56
T)pRSeqfc}B#&pwzOa|6J>&w?N

delta 740
zcma*kKWGzi6u|LsV~n{pn)H&(pS$EPm(;q|>R{_&DHRb11D%vE7R3IW#i@`kmV&gX
zzol*g5hRof#z92Ip>)uU9jZeSTtm%V5q!V?ilcb&x%a!r@7}%NyO%e5*B*~GE?mBJ
zv2t|HB!H`s+6OxhnQ_Q&7)}hde9I^dftDXJio>8eOGdFN&%#?Y!b#A|o5v<3id<ty
zZo=C$N_9BWkthmVhF<_JH*HjAK?|0T9Y_?FUBh3O{UVS<X`wW(Rda@W2%7JvWudJY
zPFGGKs;ioMV%OWR`<!UI7MqL6utxt5s|M_+Aa28W1~#$~bD))nA?b8P;&2g`B-fO<
z=)q(Nn`M{~JJQLX<mx5ph%I@i;KQ`!XDhHAz=7D6^}6H}0S#JGAXkM$7t&%ybmar9
zl9OLYl#?W=k|Rx=7^lc$(NBetfFuLhWJqxa2agg3isW%QO&OmWeMJ6I<LrMGX@9V8
zN7T)jt*#^o+B3=fCsZ$WzCD`$lvWF2roT7V`FT!yEfQ5>vZS7eQ`XZr55LPyaMkZ{
zN;RFV^>%H0TW37=wR+Eb_AdM-^P!}!*X~#k9=-S`6QitN)$Up!=ih&p<KruDaKZZ0
Nz4b#TPoUNYy+0b!dPM*L

diff --git a/pgo/pgo.go b/pgo/pgo.go
index 0ed7e1e..d1871c6 100755
--- a/pgo/pgo.go
+++ b/pgo/pgo.go
@@ -20,11 +20,17 @@ void CPxPvdTransport_release(struct CPxPvdTransport* cppt);
 
 struct CPxTolerancesScale NewCPxTolerancesScale(CPxReal length, CPxReal speed);
 
+//PxPhysics
 struct CPxPhysics* CPxCreatePhysics(struct CPxFoundation* cfoundation, struct CPxTolerancesScale cscale, bool trackOutstandingAllocations, struct CPxPvd* cpvd);
 struct CPxScene* CPxPhysics_createScene(struct CPxPhysics*, struct CPxSceneDesc*);
+struct CPxMaterial* CPxPhysics_createMaterial(struct CPxPhysics*, CPxReal staticFriction, CPxReal dynamicFriction, CPxReal restitution);
 void CPxPhysics_release(struct CPxPhysics*);
 
+//PxScene
 struct CPxPvdSceneClient* CPxScene_getScenePvdClient(struct CPxScene*);
+void CPxScene_addActor(struct CPxScene*, struct CPxActor* actor);
+void CPxScene_simulate(struct CPxScene*, CPxReal elapsedTime);
+bool CPxScene_fetchResults(struct CPxScene*, bool block, CPxU32* errorState);
 
 void CPxPvdSceneClient_setScenePvdFlag(struct CPxPvdSceneClient* c, enum CPxPvdSceneFlag flag, bool value);
 
@@ -36,6 +42,14 @@ struct CPxCpuDispatcher* CPxDefaultCpuDispatcher_toCPxCpuDispatcher(struct CPxDe
 struct CPxSceneDesc* NewCPxSceneDesc(struct CPxTolerancesScale);
 void CPxSceneDesc_set_gravity(struct CPxSceneDesc*, struct CPxVec3);
 void CPxSceneDesc_set_cpuDispatcher(struct CPxSceneDesc*, struct CPxCpuDispatcher*);
+
+//Plane
+struct CPxPlane* NewCPxPlane(float nx, float ny, float nz, float distance);
+
+//RigidStatic
+struct CPxRigidStatic* CPxCreatePlane(struct CPxPhysics* sdk, struct CPxPlane* plane, struct CPxMaterial* material);
+struct CPxActor* CPxRigidStatic_toCPxActor(struct CPxRigidStatic*);
+
 */
 import "C"
 
@@ -121,6 +135,23 @@ func (s *Scene) GetScenePvdClient() *PvdSceneClient {
 	}
 }
 
+func (s *Scene) AddActor(a *Actor) {
+	C.CPxScene_addActor(s.cS, a.cA)
+}
+
+// void CPxScene_simulate(CSTRUCT CPxScene*, CPxReal elapsedTime);
+func (s *Scene) Simulate(elapsedTime float32) {
+	C.CPxScene_simulate(s.cS, C.float(elapsedTime))
+}
+
+// bool CPxScene_fetchResults(struct CPxScene*, bool block, CPxU32* errorState);
+func (s *Scene) FetchResults(block bool) (bool, uint32) {
+
+	var errState uint32
+	b := C.CPxScene_fetchResults(s.cS, C._Bool(block), (*C.uint)(&errState))
+	return bool(b), errState
+}
+
 type Physics struct {
 	cPhysics *C.struct_CPxPhysics
 }
@@ -131,6 +162,12 @@ func (p *Physics) CreateScene(sd *SceneDesc) *Scene {
 	}
 }
 
+func (p *Physics) CreateMaterial(staticFriction, dynamicFriction, restitution float32) *Material {
+	return &Material{
+		cM: C.CPxPhysics_createMaterial(p.cPhysics, C.float(staticFriction), C.float(dynamicFriction), C.float(restitution)),
+	}
+}
+
 func CreatePhysics(f *Foundation, ts *TolerancesScale, trackOutstandingAllocations bool, pvd *Pvd) *Physics {
 
 	p := &Physics{}
@@ -161,7 +198,6 @@ type DefaultCpuDispatcher struct {
 	cDefCpuDisp *C.struct_CPxDefaultCpuDispatcher
 }
 
-// struct CPxCpuDispatcher* CPxDefaultCpuDispatcher_toCPxCpuDispatcher(struct CPxDefaultCpuDispatcher* cdcd);
 func (d *DefaultCpuDispatcher) ToCpuDispatcher() *CpuDispatcher {
 	return &CpuDispatcher{cCpuDisp: (*C.struct_CPxCpuDispatcher)(d.cDefCpuDisp)}
 }
@@ -184,7 +220,6 @@ func (sd *SceneDesc) SetCpuDispatcher(cd *CpuDispatcher) {
 	C.CPxSceneDesc_set_cpuDispatcher(sd.cSD, cd.cCpuDisp)
 }
 
-//struct CPxSceneDesc* NewCPxSceneDesc(struct CPxTolerancesScale);
 func NewSceneDesc(ts *TolerancesScale) *SceneDesc {
 	return &SceneDesc{
 		cSD: C.NewCPxSceneDesc(ts.cTolScale),
@@ -206,3 +241,39 @@ type PvdSceneClient struct {
 func (p *PvdSceneClient) SetScenePvdFlag(flag PvdSceneFlag, value bool) {
 	C.CPxPvdSceneClient_setScenePvdFlag(p.cPvdSceneClient, uint32(flag), C._Bool(value))
 }
+
+type Material struct {
+	cM *C.struct_CPxMaterial
+}
+
+type Plane struct {
+	cP *C.struct_CPxPlane
+}
+
+func NewPlane(nx, ny, nz, distance float32) *Plane {
+	return &Plane{
+		cP: C.NewCPxPlane(C.float(nx), C.float(ny), C.float(nz), C.float(distance)),
+	}
+}
+
+type Actor struct {
+	cA *C.struct_CPxActor
+}
+
+type RigidStatic struct {
+	cRs *C.struct_CPxRigidStatic
+}
+
+//struct CPxActor* CPxRigidStatic_toCPxActor(struct CPxRigidStatic*);
+func (rs *RigidStatic) ToActor() *Actor {
+	return &Actor{
+		cA: C.CPxRigidStatic_toCPxActor(rs.cRs),
+	}
+}
+
+// struct CPxRigidStatic* CPxCreatePlane(struct CPxPhysics* sdk, struct CPxPlane* plane, struct CPxMaterial* material);
+func CreatePlane(p *Physics, plane *Plane, mat *Material) *RigidStatic {
+	return &RigidStatic{
+		cRs: C.CPxCreatePlane(p.cPhysics, plane.cP, mat.cM),
+	}
+}
diff --git a/pgo/physx-c/CPxScene.h b/pgo/physx-c/CPxScene.h
index d441619..7ed75ce 100755
--- a/pgo/physx-c/CPxScene.h
+++ b/pgo/physx-c/CPxScene.h
@@ -15,6 +15,8 @@ extern "C" {
 
 	CPxAPI CSTRUCT CPxPvdSceneClient* CPxScene_getScenePvdClient(CSTRUCT CPxScene*);
 	CPxAPI void CPxScene_addActor(CSTRUCT CPxScene*, CSTRUCT CPxActor* actor);
+	CPxAPI void CPxScene_simulate(CSTRUCT CPxScene*, CPxReal elapsedTime);
+	CPxAPI bool CPxScene_fetchResults(CSTRUCT CPxScene*, bool block, CPxU32* errorState);
 
 	CPxAPI void CPxScene_release(CSTRUCT CPxScene*);