fixedpoint.py 927 B

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849
  1. import numpy as np
  2. def q31sat(x):
  3. if x > 0x7FFFFFFF:
  4. return(np.int32(0x7FFFFFFF))
  5. elif x < -0x80000000:
  6. return(np.int32(0x80000000))
  7. else:
  8. return(np.int32(x))
  9. q31satV=np.vectorize(q31sat)
  10. def toQ31(x):
  11. return(q31satV(np.round(x * (1<<31))))
  12. def q15sat(x):
  13. if x > 0x7FFF:
  14. return(np.int16(0x7FFF))
  15. elif x < -0x8000:
  16. return(np.int16(0x8000))
  17. else:
  18. return(np.int16(x))
  19. q15satV=np.vectorize(q15sat)
  20. def toQ15(x):
  21. return(q15satV(np.round(x * (1<<15))))
  22. def q7sat(x):
  23. if x > 0x7F:
  24. return(np.int8(0x7F))
  25. elif x < -0x80:
  26. return(np.int8(0x80))
  27. else:
  28. return(np.int8(x))
  29. q7satV=np.vectorize(q7sat)
  30. def toQ7(x):
  31. return(q7satV(np.round(x * (1<<7))))
  32. def Q31toF32(x):
  33. return(1.0*x / 2**31)
  34. def Q15toF32(x):
  35. return(1.0*x / 2**15)
  36. def Q7toF32(x):
  37. return(1.0*x / 2**7)