Refactor VFPU trigonometric functions and optimize non-PSP implementa…

…tions

- Replaced magic numbers with named constants
- Improved readability with more meaningful comments.
- Grouped VFPU macros and constants for better maintainability.
- Optimized non-PSP trigonometric functions by directly using sinf and cosf.