1 /***********************license start************************************
2 * Copyright (c) 2003-2017 Cavium, Inc.
3 * All rights reserved.
4 *
5 * License: one of 'Cavium License' or 'GNU General Public License Version 2'
6 *
7 * This file is provided under the terms of the Cavium License (see below)
8 * or under the terms of GNU General Public License, Version 2, as
9 * published by the Free Software Foundation. When using or redistributing
10 * this file, you may do so under either license.
11 *
12 * Cavium License: Redistribution and use in source and binary forms, with
13 * or without modification, are permitted provided that the following
14 * conditions are met:
15 *
16 * * Redistributions of source code must retain the above copyright
17 * notice, this list of conditions and the following disclaimer.
18 *
19 * * Redistributions in binary form must reproduce the above
20 * copyright notice, this list of conditions and the following
21 * disclaimer in the documentation and/or other materials provided
22 * with the distribution.
23 *
24 * * Neither the name of Cavium Inc. nor the names of its contributors may be
25 * used to endorse or promote products derived from this software without
26 * specific prior written permission.
27 *
28 * This Software, including technical data, may be subject to U.S. export
29 * control laws, including the U.S. Export Administration Act and its
30 * associated regulations, and may be subject to export or import
31 * regulations in other countries.
32 *
33 * TO THE MAXIMUM EXTENT PERMITTED BY LAW, THE SOFTWARE IS PROVIDED "AS IS"
34 * AND WITH ALL FAULTS AND CAVIUM INC. MAKES NO PROMISES, REPRESENTATIONS
35 * OR WARRANTIES, EITHER EXPRESS, IMPLIED, STATUTORY, OR OTHERWISE, WITH
36 * RESPECT TO THE SOFTWARE, INCLUDING ITS CONDITION, ITS CONFORMITY TO ANY
37 * REPRESENTATION OR DESCRIPTION, OR THE EXISTENCE OF ANY LATENT OR PATENT
38 * DEFECTS, AND CAVIUM SPECIFICALLY DISCLAIMS ALL IMPLIED (IF ANY)
39 * WARRANTIES OF TITLE, MERCHANTABILITY, NONINFRINGEMENT, FITNESS FOR A
40 * PARTICULAR PURPOSE, LACK OF VIRUSES, ACCURACY OR COMPLETENESS, QUIET
41 * ENJOYMENT, QUIET POSSESSION OR CORRESPONDENCE TO DESCRIPTION. THE
42 * ENTIRE RISK ARISING OUT OF USE OR PERFORMANCE OF THE SOFTWARE LIES
43 * WITH YOU.
44 ***********************license end**************************************/
45
46 #include "common.h"
47 #include "zip_deflate.h"
48
49 /**
50 * zip_cmd_queue_consumed - Calculates the space consumed in the command queue.
51 *
52 * @zip_dev: Pointer to zip device structure
53 * @queue: Queue number
54 *
55 * Return: Bytes consumed in the command queue buffer.
56 */
zip_cmd_queue_consumed(struct zip_device * zip_dev,int queue)57 static inline u32 zip_cmd_queue_consumed(struct zip_device *zip_dev, int queue)
58 {
59 return ((zip_dev->iq[queue].sw_head - zip_dev->iq[queue].sw_tail) *
60 sizeof(u64 *));
61 }
62
63 /**
64 * zip_load_instr - Submits the instruction into the ZIP command queue
65 * @instr: Pointer to the instruction to be submitted
66 * @zip_dev: Pointer to ZIP device structure to which the instruction is to
67 * be submitted
68 *
69 * This function copies the ZIP instruction to the command queue and rings the
70 * doorbell to notify the engine of the instruction submission. The command
71 * queue is maintained in a circular fashion. When there is space for exactly
72 * one instruction in the queue, next chunk pointer of the queue is made to
73 * point to the head of the queue, thus maintaining a circular queue.
74 *
75 * Return: Queue number to which the instruction was submitted
76 */
zip_load_instr(union zip_inst_s * instr,struct zip_device * zip_dev)77 u32 zip_load_instr(union zip_inst_s *instr,
78 struct zip_device *zip_dev)
79 {
80 union zip_quex_doorbell dbell;
81 u32 queue = 0;
82 u32 consumed = 0;
83 u64 *ncb_ptr = NULL;
84 union zip_nptr_s ncp;
85
86 /*
87 * Distribute the instructions between the enabled queues based on
88 * the CPU id.
89 */
90 if (raw_smp_processor_id() % 2 == 0)
91 queue = 0;
92 else
93 queue = 1;
94
95 zip_dbg("CPU Core: %d Queue number:%d", raw_smp_processor_id(), queue);
96
97 /* Take cmd buffer lock */
98 spin_lock(&zip_dev->iq[queue].lock);
99
100 /*
101 * Command Queue implementation
102 * 1. If there is place for new instructions, push the cmd at sw_head.
103 * 2. If there is place for exactly one instruction, push the new cmd
104 * at the sw_head. Make sw_head point to the sw_tail to make it
105 * circular. Write sw_head's physical address to the "Next-Chunk
106 * Buffer Ptr" to make it cmd_hw_tail.
107 * 3. Ring the door bell.
108 */
109 zip_dbg("sw_head : %lx", zip_dev->iq[queue].sw_head);
110 zip_dbg("sw_tail : %lx", zip_dev->iq[queue].sw_tail);
111
112 consumed = zip_cmd_queue_consumed(zip_dev, queue);
113 /* Check if there is space to push just one cmd */
114 if ((consumed + 128) == (ZIP_CMD_QBUF_SIZE - 8)) {
115 zip_dbg("Cmd queue space available for single command");
116 /* Space for one cmd, pust it and make it circular queue */
117 memcpy((u8 *)zip_dev->iq[queue].sw_head, (u8 *)instr,
118 sizeof(union zip_inst_s));
119 zip_dev->iq[queue].sw_head += 16; /* 16 64_bit words = 128B */
120
121 /* Now, point the "Next-Chunk Buffer Ptr" to sw_head */
122 ncb_ptr = zip_dev->iq[queue].sw_head;
123
124 zip_dbg("ncb addr :0x%lx sw_head addr :0x%lx",
125 ncb_ptr, zip_dev->iq[queue].sw_head - 16);
126
127 /* Using Circular command queue */
128 zip_dev->iq[queue].sw_head = zip_dev->iq[queue].sw_tail;
129 /* Mark this buffer for free */
130 zip_dev->iq[queue].free_flag = 1;
131
132 /* Write new chunk buffer address at "Next-Chunk Buffer Ptr" */
133 ncp.u_reg64 = 0ull;
134 ncp.s.addr = __pa(zip_dev->iq[queue].sw_head);
135 *ncb_ptr = ncp.u_reg64;
136 zip_dbg("*ncb_ptr :0x%lx sw_head[phys] :0x%lx",
137 *ncb_ptr, __pa(zip_dev->iq[queue].sw_head));
138
139 zip_dev->iq[queue].pend_cnt++;
140
141 } else {
142 zip_dbg("Enough space is available for commands");
143 /* Push this cmd to cmd queue buffer */
144 memcpy((u8 *)zip_dev->iq[queue].sw_head, (u8 *)instr,
145 sizeof(union zip_inst_s));
146 zip_dev->iq[queue].sw_head += 16; /* 16 64_bit words = 128B */
147
148 zip_dev->iq[queue].pend_cnt++;
149 }
150 zip_dbg("sw_head :0x%lx sw_tail :0x%lx hw_tail :0x%lx",
151 zip_dev->iq[queue].sw_head, zip_dev->iq[queue].sw_tail,
152 zip_dev->iq[queue].hw_tail);
153
154 zip_dbg(" Pushed the new cmd : pend_cnt : %d",
155 zip_dev->iq[queue].pend_cnt);
156
157 /* Ring the doorbell */
158 dbell.u_reg64 = 0ull;
159 dbell.s.dbell_cnt = 1;
160 zip_reg_write(dbell.u_reg64,
161 (zip_dev->reg_base + ZIP_QUEX_DOORBELL(queue)));
162
163 /* Unlock cmd buffer lock */
164 spin_unlock(&zip_dev->iq[queue].lock);
165
166 return queue;
167 }
168
169 /**
170 * zip_update_cmd_bufs - Updates the queue statistics after posting the
171 * instruction
172 * @zip_dev: Pointer to zip device structure
173 * @queue: Queue number
174 */
zip_update_cmd_bufs(struct zip_device * zip_dev,u32 queue)175 void zip_update_cmd_bufs(struct zip_device *zip_dev, u32 queue)
176 {
177 /* Take cmd buffer lock */
178 spin_lock(&zip_dev->iq[queue].lock);
179
180 /* Check if the previous buffer can be freed */
181 if (zip_dev->iq[queue].free_flag == 1) {
182 zip_dbg("Free flag. Free cmd buffer, adjust sw head and tail");
183 /* Reset the free flag */
184 zip_dev->iq[queue].free_flag = 0;
185
186 /* Point the hw_tail to start of the new chunk buffer */
187 zip_dev->iq[queue].hw_tail = zip_dev->iq[queue].sw_head;
188 } else {
189 zip_dbg("Free flag not set. increment hw tail");
190 zip_dev->iq[queue].hw_tail += 16; /* 16 64_bit words = 128B */
191 }
192
193 zip_dev->iq[queue].done_cnt++;
194 zip_dev->iq[queue].pend_cnt--;
195
196 zip_dbg("sw_head :0x%lx sw_tail :0x%lx hw_tail :0x%lx",
197 zip_dev->iq[queue].sw_head, zip_dev->iq[queue].sw_tail,
198 zip_dev->iq[queue].hw_tail);
199 zip_dbg(" Got CC : pend_cnt : %d\n", zip_dev->iq[queue].pend_cnt);
200
201 spin_unlock(&zip_dev->iq[queue].lock);
202 }
203