Add theta-dependent smooth interpolation, and supporting funtions#47

Steppie101 wants to merge 1 commit intoqbead:mainqbead/firmware:mainfrom

Steppie101:patch-4Steppie101/firmware:patch-4Copy head branch name to clipboard