Small Vehicle Changes, added more car tests.

Small changes to Vehicle class to ensure correct array pos was being
returned. Added tests for queue checking and park checking.