dmub/src/dmub_reg.c

0001 /*
0002  * Copyright 2019 Advanced Micro Devices, Inc.
0003  *
0004  * Permission is hereby granted, free of charge, to any person obtaining a
0005  * copy of this software and associated documentation files (the "Software"),
0006  * to deal in the Software without restriction, including without limitation
0007  * the rights to use, copy, modify, merge, publish, distribute, sublicense,
0008  * and/or sell copies of the Software, and to permit persons to whom the
0009  * Software is furnished to do so, subject to the following conditions:
0010  *
0011  * The above copyright notice and this permission notice shall be included in
0012  * all copies or substantial portions of the Software.
0013  *
0014  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
0015  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
0016  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
0017  * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
0018  * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
0019  * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
0020  * OTHER DEALINGS IN THE SOFTWARE.
0021  *
0022  * Authors: AMD
0023  *
0024  */
0025
0026 #include "dmub_reg.h"
0027 #include "../dmub_srv.h"
0028
0029 struct dmub_reg_value_masks {
0030     uint32_t value;
0031     uint32_t mask;
0032 };
0033
0034 static inline void
0035 set_reg_field_value_masks(struct dmub_reg_value_masks *field_value_mask,
0036               uint32_t value, uint32_t mask, uint8_t shift)
0037 {
0038     field_value_mask->value =
0039         (field_value_mask->value & ~mask) | (mask & (value << shift));
0040     field_value_mask->mask = field_value_mask->mask | mask;
0041 }
0042
0043 static void set_reg_field_values(struct dmub_reg_value_masks *field_value_mask,
0044                  uint32_t addr, int n, uint8_t shift1,
0045                  uint32_t mask1, uint32_t field_value1,
0046                  va_list ap)
0047 {
0048     uint32_t shift, mask, field_value;
0049     int i = 1;
0050
0051     /* gather all bits value/mask getting updated in this register */
0052     set_reg_field_value_masks(field_value_mask, field_value1, mask1,
0053                   shift1);
0054
0055     while (i < n) {
0056         shift = va_arg(ap, uint32_t);
0057         mask = va_arg(ap, uint32_t);
0058         field_value = va_arg(ap, uint32_t);
0059
0060         set_reg_field_value_masks(field_value_mask, field_value, mask,
0061                       shift);
0062         i++;
0063     }
0064 }
0065
0066 static inline uint32_t get_reg_field_value_ex(uint32_t reg_value, uint32_t mask,
0067                           uint8_t shift)
0068 {
0069     return (mask & reg_value) >> shift;
0070 }
0071
0072 void dmub_reg_update(struct dmub_srv *srv, uint32_t addr, int n, uint8_t shift1,
0073              uint32_t mask1, uint32_t field_value1, ...)
0074 {
0075     struct dmub_reg_value_masks field_value_mask = { 0 };
0076     uint32_t reg_val;
0077     va_list ap;
0078
0079     va_start(ap, field_value1);
0080     set_reg_field_values(&field_value_mask, addr, n, shift1, mask1,
0081                  field_value1, ap);
0082     va_end(ap);
0083
0084     reg_val = srv->funcs.reg_read(srv->user_ctx, addr);
0085     reg_val = (reg_val & ~field_value_mask.mask) | field_value_mask.value;
0086     srv->funcs.reg_write(srv->user_ctx, addr, reg_val);
0087 }
0088
0089 void dmub_reg_set(struct dmub_srv *srv, uint32_t addr, uint32_t reg_val, int n,
0090           uint8_t shift1, uint32_t mask1, uint32_t field_value1, ...)
0091 {
0092     struct dmub_reg_value_masks field_value_mask = { 0 };
0093     va_list ap;
0094
0095     va_start(ap, field_value1);
0096     set_reg_field_values(&field_value_mask, addr, n, shift1, mask1,
0097                  field_value1, ap);
0098     va_end(ap);
0099
0100     reg_val = (reg_val & ~field_value_mask.mask) | field_value_mask.value;
0101     srv->funcs.reg_write(srv->user_ctx, addr, reg_val);
0102 }
0103
0104 void dmub_reg_get(struct dmub_srv *srv, uint32_t addr, uint8_t shift,
0105           uint32_t mask, uint32_t *field_value)
0106 {
0107     uint32_t reg_val = srv->funcs.reg_read(srv->user_ctx, addr);
0108     *field_value = get_reg_field_value_ex(reg_val, mask, shift);
0109 }