Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * @File	cthardware.c
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  * @Brief
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8)  * This file contains the implementation of hardware access methord.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10)  * @Author	Liu Chun
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11)  * @Date 	Jun 26 2008
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include "cthardware.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include "cthw20k1.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) #include "cthw20k2.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) #include <linux/bug.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) int create_hw_obj(struct pci_dev *pci, enum CHIPTYP chip_type,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 		  enum CTCARDS model, struct hw **rhw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 	switch (chip_type) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 	case ATC20K1:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 		err = create_20k1_hw_obj(rhw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	case ATC20K2:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 		err = create_20k2_hw_obj(rhw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 		err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 	if (err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	(*rhw)->pci = pci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	(*rhw)->chip_type = chip_type;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 	(*rhw)->model = model;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) int destroy_hw_obj(struct hw *hw)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 	switch (hw->pci->device) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 	case 0x0005:	/* 20k1 device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 		err = destroy_20k1_hw_obj(hw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	case 0x000B:	/* 20k2 device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 		err = destroy_20k2_hw_obj(hw);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 		err = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) 	return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) unsigned int get_field(unsigned int data, unsigned int field)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	if (WARN_ON(!field))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 	/* @field should always be greater than 0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	for (i = 0; !(field & (1 << i)); )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) 		i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) 	return (data & field) >> i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) void set_field(unsigned int *data, unsigned int field, unsigned int value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 	if (WARN_ON(!field))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 		return;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) 	/* @field should always be greater than 0 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 	for (i = 0; !(field & (1 << i)); )
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) 		i++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) 	*data = (*data & (~field)) | ((value << i) & field);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89)