Add CSD register read function
Add size calculation