thread safe static variables

[jsupratman13]

Change Summary

• fix #56

Details

Impacts

References

Additional Information

• I'm welcome to other alternatives.

[jsupratman13]

Apply changes to wheel_controller. Servo controller will be applied on next PR.