Push matrix and trig functions help (robot BD-1)

Looks awesome!!!

Congratulations!!!