Function getVector:Float[](pitch#, yaw#, radius#)
  Local result:Float[3]

  pitch = (pitch+360) Mod 360
  yaw   = (yaw  +360) Mod 360

         '50% Ausprobieren + 50% Mathe -> diese Lösung

  result[0] = Sin(yaw)*Cos(pitch)*radius
  result[1] = Sin(pitch)*radius
  result[2] = -Cos(pitch)*Cos(yaw)*radius

  Return result
End Function

Function getVectorInfo:Float[](x#, y#, z#)
  Local result:Float[2]
              'thank you, Noobody; https://www.blitzforum.de/forum/viewtopic.php?p=297457#297457

  result[0] = (ATan2(y, Sqr(x*x + z*z))+360) Mod 360
  result[1] = (ATan2(-z, -x) - 90      +360) Mod 360

  Return result
End Function

SuperStrict

Import sidesign.minib3d

Const sx:Int=800,sy:Int=600

Graphics3D sx,sy,16,2

Local cam:TCamera=CreateCamera()
CameraRange cam,.5,500
PositionEntity cam,0,0,-50

Local light:TLight=CreateLight(1)
RotateEntity light,90,0,0
PositionEntity light, 0, 5, -25

Global cone:TMesh = CreateCone()
RotateMesh cone, 90, 0, 0
ScaleEntity cone, 2, 2, 10

Global cone2:TMesh = CreateCone()
RotateMesh cone2, 90, 0, 0
ScaleEntity cone2, 2, 2, 10
PositionEntity cone2, 10, 0, 0
EntityColor cone2, 255, 0, 0

Local sphere:TMesh = CreateSphere()
EntityColor sphere, 0, 0, 255

Const radius%= 12

OnEnd cleanUp

Function cleanUp()
  GCCollect
End Function

Local timer:TTimer = CreateTimer(60)
Global pitch#, yaw#, roll#

Repeat
  If KeyDown(KEY_P) Then
    If KeyDown(KEY_LEFT) Then
      pitch :- 1
    ElseIf KeyDown(KEY_RIGHT)
      pitch :+ 1
    EndIf
  ElseIf KeyDown(KEY_Y) Then
    If KeyDown(KEY_LEFT) Then
      yaw   :- 1
    ElseIf KeyDown(KEY_RIGHT)
      yaw   :+ 1
    EndIf
  ElseIf KeyDown(KEY_R) Then
    If KeyDown(KEY_LEFT) Then
      roll  :- 1
    ElseIf KeyDown(KEY_RIGHT)
      roll  :+ 1
    EndIf
  EndIf
  pitch :Mod 360
  yaw   :Mod 360
  roll  :Mod 360
  RotateEntity cone, pitch, yaw, roll
  Local pos#[] = getVector(pitch, yaw, radius)
  PositionEntity sphere, EntityX(cone)+pos[0], EntityY(cone)+pos[1], EntityZ(cone)+pos[2]
  'pitch = pos[0]
  'yaw   = pos[1]
  RotateEntity cone, pitch, yaw, roll
  pos = getVector(pitch, yaw, .1)
  MoveEntity cone, pos[0], pos[1], pos[2]
  pos = getVector(EntityPitch(cone2), EntityYaw(cone2), .1)
  MoveEntity cone2, pos[0], pos[1], pos[2]
  UpdateWorld
  RenderWorld
  Text 0, 0,  "Pitch: "+EntityPitch(cone)
  Text 0, 30, "Yaw: "  +EntityYaw(cone)
  Text 0, 60, "Roll: " +EntityRoll(cone)
  Flip
  WaitTimer timer
Until KeyHit(KEY_ESCAPE)



Function normalDeg#(deg#)
  Return (deg+360) Mod 360
End Function
Function degDiff#(deg1#, deg2#)
  deg1 = normalDeg(deg1)
  deg2 = normalDeg(deg2)
  Return Min(deg1-deg2, Min((deg1+360)-deg2, deg1-(deg2+360)))
End Function


Function getVector:Float[](pitch#, yaw#, radius#)
  Local result:Float[5]

  pitch = (pitch+360) Mod 360
  yaw   = (yaw  +360) Mod 360


  result[0] = Sin(yaw)*Cos(pitch)*radius
  result[1] = Sin(pitch)*radius
  result[2] = -Cos(pitch)*Cos(yaw)*radius

     'DEBUG

  Local info:Float[] = getVectorInfo(result[0], result[1], result[2])


  If Abs(info[0] - pitch) > 1 Then
    DebugLog "pitch = "+pitch+"; info[0] = "+info[0]
  EndIf
  If Abs(info[1] - yaw) > 1 Then
    DebugLog "yaw   = "+yaw+"; info[1] = "+info[1]
  EndIf
  If Abs(info[0] - pitch) > 1 Or Abs(info[1] - yaw) > 1 Then
    DebugLog "result[0] = "+result[0]
    DebugLog "result[1] = "+result[1]
    DebugLog "result[2] = "+result[2]
    DebugLog ""
  EndIf

  'result[3] = info[0]
  'result[4] = info[1]



  RotateEntity cone2, info[0], info[1], 0
  Return result
End Function

Function getVectorInfo:Float[](x#, y#, z#)
  Local result:Float[2]
              'thank you, Noobody; http://www.blitzforum.de/forum/viewtopic.php?p=297457#297457

  result[0] = (ATan2(y, Sqr(x*x + z*z))+360) Mod 360
  result[1] = (ATan2(-z, -x) - 90      +360) Mod 360

  'If result[0] >= 90 And result[0] <= 270 Then result[1] = (result[1] + 180) Mod 360

  Return result
End Function

End