libuuu/hidreport.cpp

   1 /*
   2  * Copyright 2020 NXP.
   3  *
   4  * Redistribution and use in source and binary forms, with or without modification,
   5  * are permitted provided that the following conditions are met:
   6  *
   7  * Redistributions of source code must retain the above copyright notice, this
   8  * list of conditions and the following disclaimer.
   9  *
  10  * Redistributions in binary form must reproduce the above copyright notice, this
  11  * list of conditions and the following disclaimer in the documentation and/or
  12  * other materials provided with the distribution.
  13  *
  14  * Neither the name of the NXP Semiconductor nor the names of its
  15  * contributors may be used to endorse or promote products derived from this
  16  * software without specific prior written permission.
  17  *
  18  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
  19  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
  20  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
  21  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
  22  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
  23  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
  24  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
  25  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
  26  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
  27  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  28  * POSSIBILITY OF SUCH DAMAGE.
  29  *
  30  */
  31
  32 #include "hidreport.h"
  33 #include "libcomm.h"
  34 #include "liberror.h"
  35 #include "trans.h"
  36
  37 #include <cstring>
  38
  39 HIDReport::~HIDReport()
  40 {
  41 }
  42
  43 void HIDReport::notify(size_t index, uuu_notify::NOTIFY_TYPE type)
  44 {
  45         uuu_notify nf;
  46         nf.type = type;
  47         if(type == uuu_notify::NOTIFY_TRANS_POS)
  48                 nf.index = index + m_postion_base;
  49         if (type == uuu_notify::NOTIFY_TRANS_SIZE)
  50         {
  51                 nf.index = m_notify_total > index ? m_notify_total : index;
  52         }
  53         call_notify(nf);
  54 }
  55
  56 int HIDReport::read(std::vector<uint8_t> &buff)
  57 {
  58         if (buff.size() < m_size_in + m_size_payload)
  59         {
  60                 set_last_err_string("buffer to small to get a package");
  61                 return -1;
  62         }
  63         size_t rs;
  64         int ret = m_pdev->read(buff.data(), m_size_in + m_size_payload, &rs);
  65
  66         return ret;
  67 }
  68
  69 int HIDReport::write(const void *p, size_t sz, uint8_t report_id)
  70 {
  71         notify(sz, uuu_notify::NOTIFY_TRANS_SIZE);
  72
  73         const uint8_t * const buff = reinterpret_cast<const uint8_t *>(p);
  74         size_t off = 0;
  75         for (; off < sz; off += m_size_out)
  76         {
  77                 m_out_buff[0] = report_id;
  78
  79                 size_t s = sz - off;
  80                 if (s > m_size_out)
  81                         s = m_size_out;
  82
  83                 memcpy(m_out_buff.data() + m_size_payload, buff + off, s);
  84
  85                 int ret = m_pdev->write(m_out_buff.data(), report_id == 1? s + m_size_payload: m_size_out + m_size_payload);
  86
  87                 if (ret < 0)
  88                         return -1;
  89
  90                 if (off % 0x1F == 0)
  91                 {
  92                         notify(off, uuu_notify::NOTIFY_TRANS_POS);
  93                 }
  94         }
  95         notify(off, uuu_notify::NOTIFY_TRANS_POS);
  96         return 0;
  97 }