18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved. 48c2ecf20Sopenharmony_ci * 58c2ecf20Sopenharmony_ci * @File cthardware.c 68c2ecf20Sopenharmony_ci * 78c2ecf20Sopenharmony_ci * @Brief 88c2ecf20Sopenharmony_ci * This file contains the implementation of hardware access methord. 98c2ecf20Sopenharmony_ci * 108c2ecf20Sopenharmony_ci * @Author Liu Chun 118c2ecf20Sopenharmony_ci * @Date Jun 26 2008 128c2ecf20Sopenharmony_ci */ 138c2ecf20Sopenharmony_ci 148c2ecf20Sopenharmony_ci#include "cthardware.h" 158c2ecf20Sopenharmony_ci#include "cthw20k1.h" 168c2ecf20Sopenharmony_ci#include "cthw20k2.h" 178c2ecf20Sopenharmony_ci#include <linux/bug.h> 188c2ecf20Sopenharmony_ci 198c2ecf20Sopenharmony_ciint create_hw_obj(struct pci_dev *pci, enum CHIPTYP chip_type, 208c2ecf20Sopenharmony_ci enum CTCARDS model, struct hw **rhw) 218c2ecf20Sopenharmony_ci{ 228c2ecf20Sopenharmony_ci int err; 238c2ecf20Sopenharmony_ci 248c2ecf20Sopenharmony_ci switch (chip_type) { 258c2ecf20Sopenharmony_ci case ATC20K1: 268c2ecf20Sopenharmony_ci err = create_20k1_hw_obj(rhw); 278c2ecf20Sopenharmony_ci break; 288c2ecf20Sopenharmony_ci case ATC20K2: 298c2ecf20Sopenharmony_ci err = create_20k2_hw_obj(rhw); 308c2ecf20Sopenharmony_ci break; 318c2ecf20Sopenharmony_ci default: 328c2ecf20Sopenharmony_ci err = -ENODEV; 338c2ecf20Sopenharmony_ci break; 348c2ecf20Sopenharmony_ci } 358c2ecf20Sopenharmony_ci if (err) 368c2ecf20Sopenharmony_ci return err; 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci (*rhw)->pci = pci; 398c2ecf20Sopenharmony_ci (*rhw)->chip_type = chip_type; 408c2ecf20Sopenharmony_ci (*rhw)->model = model; 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_ci return 0; 438c2ecf20Sopenharmony_ci} 448c2ecf20Sopenharmony_ci 458c2ecf20Sopenharmony_ciint destroy_hw_obj(struct hw *hw) 468c2ecf20Sopenharmony_ci{ 478c2ecf20Sopenharmony_ci int err; 488c2ecf20Sopenharmony_ci 498c2ecf20Sopenharmony_ci switch (hw->pci->device) { 508c2ecf20Sopenharmony_ci case 0x0005: /* 20k1 device */ 518c2ecf20Sopenharmony_ci err = destroy_20k1_hw_obj(hw); 528c2ecf20Sopenharmony_ci break; 538c2ecf20Sopenharmony_ci case 0x000B: /* 20k2 device */ 548c2ecf20Sopenharmony_ci err = destroy_20k2_hw_obj(hw); 558c2ecf20Sopenharmony_ci break; 568c2ecf20Sopenharmony_ci default: 578c2ecf20Sopenharmony_ci err = -ENODEV; 588c2ecf20Sopenharmony_ci break; 598c2ecf20Sopenharmony_ci } 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_ci return err; 628c2ecf20Sopenharmony_ci} 638c2ecf20Sopenharmony_ci 648c2ecf20Sopenharmony_ciunsigned int get_field(unsigned int data, unsigned int field) 658c2ecf20Sopenharmony_ci{ 668c2ecf20Sopenharmony_ci int i; 678c2ecf20Sopenharmony_ci 688c2ecf20Sopenharmony_ci if (WARN_ON(!field)) 698c2ecf20Sopenharmony_ci return 0; 708c2ecf20Sopenharmony_ci /* @field should always be greater than 0 */ 718c2ecf20Sopenharmony_ci for (i = 0; !(field & (1 << i)); ) 728c2ecf20Sopenharmony_ci i++; 738c2ecf20Sopenharmony_ci 748c2ecf20Sopenharmony_ci return (data & field) >> i; 758c2ecf20Sopenharmony_ci} 768c2ecf20Sopenharmony_ci 778c2ecf20Sopenharmony_civoid set_field(unsigned int *data, unsigned int field, unsigned int value) 788c2ecf20Sopenharmony_ci{ 798c2ecf20Sopenharmony_ci int i; 808c2ecf20Sopenharmony_ci 818c2ecf20Sopenharmony_ci if (WARN_ON(!field)) 828c2ecf20Sopenharmony_ci return; 838c2ecf20Sopenharmony_ci /* @field should always be greater than 0 */ 848c2ecf20Sopenharmony_ci for (i = 0; !(field & (1 << i)); ) 858c2ecf20Sopenharmony_ci i++; 868c2ecf20Sopenharmony_ci 878c2ecf20Sopenharmony_ci *data = (*data & (~field)) | ((value << i) & field); 888c2ecf20Sopenharmony_ci} 898c2ecf20Sopenharmony_ci 90