hardware/zeroplus-logic-cube/protocol.c

   1 /*
   2  * This file is part of the libsigrok project.
   3  *
   4  * Copyright (C) 2010-2012 Bert Vermeulen <bert@biot.com>
   5  *
   6  * This program is free software: you can redistribute it and/or modify
   7  * it under the terms of the GNU General Public License as published by
   8  * the Free Software Foundation, either version 3 of the License, or
   9  * (at your option) any later version.
  10  *
  11  * This program is distributed in the hope that it will be useful,
  12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  * GNU General Public License for more details.
  15  *
  16  * You should have received a copy of the GNU General Public License
  17  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
  18  */
  19
  20 #include "protocol.h"
  21
  22 SR_PRIV unsigned int get_memory_size(int type)
  23 {
  24         if (type == MEMORY_SIZE_8K)
  25                 return 8 * 1024;
  26         else if (type <= MEMORY_SIZE_8M)
  27                 return (32 * 1024) << type;
  28         else
  29                 return 0;
  30 }
  31
  32 SR_PRIV int clz(unsigned int x)
  33 {
  34         int n = 0;
  35         if (x == 0)
  36                 return 32;
  37         if (!(x & 0xFFFF0000)) {
  38                 n = n + 16;
  39                 x = x << 16;
  40         }
  41         if (!(x & 0xFF000000)) {
  42                 n = n + 8;
  43                 x = x << 8;
  44         }
  45         if (!(x & 0xF0000000)) {
  46                 n = n + 4;
  47                 x = x << 4;
  48         }
  49         if (!(x & 0xC0000000)) {
  50                 n = n + 2;
  51                 x = x << 2;
  52         }
  53         if (!(x & 0x80000000))
  54                 n = n + 1;
  55         return n;
  56 }
  57
  58 SR_PRIV int set_limit_samples(struct dev_context *devc, uint64_t samples)
  59 {
  60         if (samples > devc->max_sample_depth)
  61                 samples = devc->max_sample_depth;
  62
  63         devc->limit_samples = samples;
  64
  65         if (samples <= 2 * 1024)
  66                 devc->memory_size = MEMORY_SIZE_8K;
  67         else if (samples <= 16 * 1024)
  68                 devc->memory_size = MEMORY_SIZE_64K;
  69         else
  70                 devc->memory_size = 19 - clz(samples - 1);
  71
  72         sr_info("Setting memory size to %dK.",
  73                 get_memory_size(devc->memory_size) / 1024);
  74
  75         analyzer_set_memory_size(devc->memory_size);
  76
  77         return SR_OK;
  78 }
  79
  80 SR_PRIV int set_capture_ratio(struct dev_context *devc, uint64_t ratio)
  81 {
  82         if (ratio > 100) {
  83                 sr_err("Invalid capture ratio: %" PRIu64 ".", ratio);
  84                 return SR_ERR_ARG;
  85         }
  86
  87         devc->capture_ratio = ratio;
  88
  89         sr_info("Setting capture ratio to %d%%.", devc->capture_ratio);
  90
  91         return SR_OK;
  92 }
  93
  94 SR_PRIV void set_triggerbar(struct dev_context *devc)
  95 {
  96         unsigned int ramsize, n, triggerbar;
  97
  98         ramsize = get_memory_size(devc->memory_size) / 4;
  99         if (devc->trigger) {
 100                 n = ramsize;
 101                 if (devc->max_sample_depth < n)
 102                         n = devc->max_sample_depth;
 103                 if (devc->limit_samples < n)
 104                         n = devc->limit_samples;
 105                 n = n * devc->capture_ratio / 100;
 106                 if (n > ramsize - 8)
 107                         triggerbar = ramsize - 8;
 108                 else
 109                         triggerbar = n;
 110         } else {
 111                 triggerbar = 0;
 112         }
 113         analyzer_set_triggerbar_address(triggerbar);
 114         analyzer_set_ramsize_trigger_address(ramsize - triggerbar);
 115
 116         sr_dbg("triggerbar_address = %d(0x%x)", triggerbar, triggerbar);
 117         sr_dbg("ramsize_triggerbar_address = %d(0x%x)",
 118                ramsize - triggerbar, ramsize - triggerbar);
 119 }