@@ -595,8 +595,8 @@ static int nvmem_cell_info_to_nvmem_cell_entry_nodup(struct nvmem_device *nvmem,
595595 cell -> np = info -> np ;
596596
597597 if (cell -> nbits )
598- cell -> bytes = DIV_ROUND_UP (cell -> nbits + cell -> bit_offset ,
599- BITS_PER_BYTE );
598+ cell -> bytes = round_up ( DIV_ROUND_UP (cell -> nbits + cell -> bit_offset ,
599+ BITS_PER_BYTE ), nvmem -> word_size ) ;
600600
601601 if (!IS_ALIGNED (cell -> offset , nvmem -> stride )) {
602602 dev_err (& nvmem -> dev ,
@@ -837,11 +837,6 @@ static int nvmem_add_cells_from_dt(struct nvmem_device *nvmem, struct device_nod
837837 if (addr && len == (2 * sizeof (u32 ))) {
838838 info .bit_offset = be32_to_cpup (addr ++ );
839839 info .nbits = be32_to_cpup (addr );
840- if (info .bit_offset >= BITS_PER_BYTE || info .nbits < 1 ) {
841- dev_err (dev , "nvmem: invalid bits on %pOF\n" , child );
842- of_node_put (child );
843- return - EINVAL ;
844- }
845840 }
846841
847842 info .np = of_node_get (child );
@@ -1630,15 +1625,23 @@ EXPORT_SYMBOL_GPL(nvmem_cell_put);
16301625static void nvmem_shift_read_buffer_in_place (struct nvmem_cell_entry * cell , void * buf )
16311626{
16321627 u8 * p , * b ;
1633- int i , extra , bit_offset = cell -> bit_offset ;
1628+ int i , padding , extra , bit_offset = cell -> bit_offset ;
1629+ int bytes = cell -> bytes ;
16341630
16351631 p = b = buf ;
16361632 if (bit_offset ) {
1633+ padding = bit_offset /8 ;
1634+ if (padding ) {
1635+ memmove (buf , buf + padding , bytes - padding );
1636+ bit_offset -= BITS_PER_BYTE * padding ;
1637+ bytes -= padding ;
1638+ }
1639+
16371640 /* First shift */
16381641 * b ++ >>= bit_offset ;
16391642
16401643 /* setup rest of the bytes if any */
1641- for (i = 1 ; i < cell -> bytes ; i ++ ) {
1644+ for (i = 1 ; i < bytes ; i ++ ) {
16421645 /* Get bits from next byte and shift them towards msb */
16431646 * p |= * b << (BITS_PER_BYTE - bit_offset );
16441647
@@ -1651,7 +1654,7 @@ static void nvmem_shift_read_buffer_in_place(struct nvmem_cell_entry *cell, void
16511654 }
16521655
16531656 /* result fits in less bytes */
1654- extra = cell -> bytes - DIV_ROUND_UP (cell -> nbits , BITS_PER_BYTE );
1657+ extra = bytes - DIV_ROUND_UP (cell -> nbits , BITS_PER_BYTE );
16551658 while (-- extra >= 0 )
16561659 * p -- = 0 ;
16571660
0 commit comments