RCCarExtensions.swift

import simd

public extension float4x4 {
  var forwardVector: simd_float3 {
    simd_float3(columns.2.x, columns.2.y, columns.2.z).normalized
  }
  func movedForwardPosition(speed: Float) -> float4x4 {
    var returnValue = self
    returnValue.columns.3.x += (forwardVector.x * speed)
    returnValue.columns.3.y += (forwardVector.y * speed)
    returnValue.columns.3.z += (forwardVector.z * speed)
    return returnValue
  }
}

extension Float {
  var degreesToRadians: Float { self * .pi / 180 }
}

public extension simd_float3 {
  var negated: simd_float3 { self * -1 }
  var magnitude: Float { sqrtf(x*x + y*y + z*z) }
  var normalized: simd_float3 { return self / magnitude }
}