Cleanup parser code and make it more BeRTOS compliant.