Fix bug in getting frame data
Fixed getting scaled depth data
Clean up cruft