Clean up code, add todos