#endif
 }
 
-static inline void rps_input_queue_head_incr(struct softnet_data *sd)
+static inline void rps_input_queue_head_add(struct softnet_data *sd, int val)
 {
 #ifdef CONFIG_RPS
-       sd->input_queue_head++;
+       WRITE_ONCE(sd->input_queue_head, sd->input_queue_head + val);
 #endif
 }
 
+static inline void rps_input_queue_head_incr(struct softnet_data *sd)
+{
+       rps_input_queue_head_add(sd, 1);
+}
+
 #endif /* _NET_RPS_H */
 
        out:
 #endif
                rflow->last_qtail =
-                       per_cpu(softnet_data, next_cpu).input_queue_head;
+                       READ_ONCE(per_cpu(softnet_data, next_cpu).input_queue_head);
        }
 
        rflow->cpu = next_cpu;
                 */
                if (unlikely(tcpu != next_cpu) &&
                    (tcpu >= nr_cpu_ids || !cpu_online(tcpu) ||
-                    ((int)(per_cpu(softnet_data, tcpu).input_queue_head -
+                    ((int)(READ_ONCE(per_cpu(softnet_data, tcpu).input_queue_head) -
                      READ_ONCE(rflow->last_qtail))) >= 0)) {
                        tcpu = next_cpu;
                        rflow = set_rps_cpu(dev, skb, rflow, next_cpu);
                rflow = &flow_table->flows[flow_id];
                cpu = READ_ONCE(rflow->cpu);
                if (rflow->filter == filter_id && cpu < nr_cpu_ids &&
-                   ((int)(per_cpu(softnet_data, cpu).input_queue_head -
+                   ((int)(READ_ONCE(per_cpu(softnet_data, cpu).input_queue_head) -
                           READ_ONCE(rflow->last_qtail)) <
                     (int)(10 * flow_table->mask)))
                        expire = false;
                        rcu_read_lock();
                        __netif_receive_skb(skb);
                        rcu_read_unlock();
-                       rps_input_queue_head_incr(sd);
-                       if (++work >= quota)
+                       if (++work >= quota) {
+                               rps_input_queue_head_add(sd, work);
                                return work;
+                       }
 
                }
 
                backlog_unlock_irq_enable(sd);
        }
 
+       if (work)
+               rps_input_queue_head_add(sd, work);
        return work;
 }