@@ -592,8 +592,8 @@ static int nvmem_cell_info_to_nvmem_cell_entry_nodup(struct nvmem_device *nvmem,
592592 cell -> np = info -> np ;
593593
594594 if (cell -> nbits )
595- cell -> bytes = DIV_ROUND_UP (cell -> nbits + cell -> bit_offset ,
596- BITS_PER_BYTE );
595+ cell -> bytes = round_up ( DIV_ROUND_UP (cell -> nbits + cell -> bit_offset ,
596+ BITS_PER_BYTE ), nvmem -> word_size ) ;
597597
598598 if (!IS_ALIGNED (cell -> offset , nvmem -> stride )) {
599599 dev_err (& nvmem -> dev ,
@@ -834,11 +834,6 @@ static int nvmem_add_cells_from_dt(struct nvmem_device *nvmem, struct device_nod
834834 if (addr && len == (2 * sizeof (u32 ))) {
835835 info .bit_offset = be32_to_cpup (addr ++ );
836836 info .nbits = be32_to_cpup (addr );
837- if (info .bit_offset >= BITS_PER_BYTE || info .nbits < 1 ) {
838- dev_err (dev , "nvmem: invalid bits on %pOF\n" , child );
839- of_node_put (child );
840- return - EINVAL ;
841- }
842837 }
843838
844839 info .np = of_node_get (child );
@@ -1627,15 +1622,23 @@ EXPORT_SYMBOL_GPL(nvmem_cell_put);
16271622static void nvmem_shift_read_buffer_in_place (struct nvmem_cell_entry * cell , void * buf )
16281623{
16291624 u8 * p , * b ;
1630- int i , extra , bit_offset = cell -> bit_offset ;
1625+ int i , padding , extra , bit_offset = cell -> bit_offset ;
1626+ int bytes = cell -> bytes ;
16311627
16321628 p = b = buf ;
16331629 if (bit_offset ) {
1630+ padding = bit_offset /8 ;
1631+ if (padding ) {
1632+ memmove (buf , buf + padding , bytes - padding );
1633+ bit_offset -= BITS_PER_BYTE * padding ;
1634+ bytes -= padding ;
1635+ }
1636+
16341637 /* First shift */
16351638 * b ++ >>= bit_offset ;
16361639
16371640 /* setup rest of the bytes if any */
1638- for (i = 1 ; i < cell -> bytes ; i ++ ) {
1641+ for (i = 1 ; i < bytes ; i ++ ) {
16391642 /* Get bits from next byte and shift them towards msb */
16401643 * p |= * b << (BITS_PER_BYTE - bit_offset );
16411644
@@ -1648,7 +1651,7 @@ static void nvmem_shift_read_buffer_in_place(struct nvmem_cell_entry *cell, void
16481651 }
16491652
16501653 /* result fits in less bytes */
1651- extra = cell -> bytes - DIV_ROUND_UP (cell -> nbits , BITS_PER_BYTE );
1654+ extra = bytes - DIV_ROUND_UP (cell -> nbits , BITS_PER_BYTE );
16521655 while (-- extra >= 0 )
16531656 * p -- = 0 ;
16541657
0 commit comments