feat(safety): prevent entering R2D if BPS reads 0

[tgodfrey0]

If the brake pressure sensor reads 0 prevent entering the R2D state. If in the R2D state then exit and throw an error

Requirements

• [x] Prevent entering R2D
• [x] Early exit from R2D