Check negative Motor_Velocity logic (reverse gear)

[diyarajon]

Describe the bug
There may be places where Motor_velocity logic does not account for negative velocity. So, the logic needs to be changed to handle negative/reverse gear cases
To Reproduce
Steps to reproduce the behavior:

1. Which feature is being tested?
2. Which requirements are being tested?
3. Which test is used?
4. What is the hardware configuration?
5. What combination of inputs cause the error?
6. What does the error look like?
7. Does this issue already exist?

Expected behavior
A clear and concise description of what you expected to happen.

Screenshots
If applicable, add screenshots to help explain your problem.

Additional context
Add any other context about the problem here.