1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
|
/* SPDX-License-Identifier: BSD-2-Clause */
/*
* Copyright (C) 2019, Raspberry Pi (Trading) Limited
*
* agc.hpp - AGC/AEC control algorithm
*/
#pragma once
#include <vector>
#include <mutex>
#include "../agc_algorithm.hpp"
#include "../agc_status.h"
#include "../pwl.hpp"
// This is our implementation of AGC.
// This is the number actually set up by the firmware, not the maximum possible
// number (which is 16).
#define AGC_STATS_SIZE 15
namespace RPiController {
struct AgcMeteringMode {
double weights[AGC_STATS_SIZE];
void Read(boost::property_tree::ptree const ¶ms);
};
struct AgcExposureMode {
std::vector<double> shutter;
std::vector<double> gain;
void Read(boost::property_tree::ptree const ¶ms);
};
struct AgcConstraint {
enum class Bound { LOWER = 0, UPPER = 1 };
Bound bound;
double q_lo;
double q_hi;
Pwl Y_target;
void Read(boost::property_tree::ptree const ¶ms);
};
typedef std::vector<AgcConstraint> AgcConstraintMode;
struct AgcConfig {
void Read(boost::property_tree::ptree const ¶ms);
std::map<std::string, AgcMeteringMode> metering_modes;
std::map<std::string, AgcExposureMode> exposure_modes;
std::map<std::string, AgcConstraintMode> constraint_modes;
Pwl Y_target;
double speed;
uint16_t startup_frames;
double max_change;
double min_change;
double fast_reduce_threshold;
double speed_up_threshold;
std::string default_metering_mode;
std::string default_exposure_mode;
std::string default_constraint_mode;
double base_ev;
double default_exposure_time;
double default_analogue_gain;
};
class Agc : public AgcAlgorithm
{
public:
Agc(Controller *controller);
char const *Name() const override;
void Read(boost::property_tree::ptree const ¶ms) override;
void SetEv(double ev) override;
void SetFlickerPeriod(double flicker_period) override;
void SetFixedShutter(double fixed_shutter) override; // microseconds
void SetFixedAnalogueGain(double fixed_analogue_gain) override;
void SetMeteringMode(std::string const &metering_mode_name) override;
void SetExposureMode(std::string const &exposure_mode_name) override;
void SetConstraintMode(std::string const &contraint_mode_name) override;
void SwitchMode(CameraMode const &camera_mode, Metadata *metadata) override;
void Prepare(Metadata *image_metadata) override;
void Process(StatisticsPtr &stats, Metadata *image_metadata) override;
private:
void updateLockStatus(DeviceStatus const &device_status);
AgcConfig config_;
void housekeepConfig();
void fetchCurrentExposure(Metadata *image_metadata);
void fetchAwbStatus(Metadata *image_metadata);
void computeGain(bcm2835_isp_stats *statistics, Metadata *image_metadata,
double &gain, double &target_Y);
void computeTargetExposure(double gain);
bool applyDigitalGain(double gain, double target_Y);
void filterExposure(bool desaturate);
void divideUpExposure();
void writeAndFinish(Metadata *image_metadata, bool desaturate);
AgcMeteringMode *metering_mode_;
AgcExposureMode *exposure_mode_;
AgcConstraintMode *constraint_mode_;
uint64_t frame_count_;
AwbStatus awb_;
struct ExposureValues {
ExposureValues() : shutter(0), analogue_gain(0),
total_exposure(0), total_exposure_no_dg(0) {}
double shutter;
double analogue_gain;
double total_exposure;
double total_exposure_no_dg; // without digital gain
};
ExposureValues current_; // values for the current frame
ExposureValues target_; // calculate the values we want here
ExposureValues filtered_; // these values are filtered towards target
AgcStatus status_;
int lock_count_;
DeviceStatus last_device_status_;
double last_target_exposure_;
// Below here the "settings" that applications can change.
std::string metering_mode_name_;
std::string exposure_mode_name_;
std::string constraint_mode_name_;
double ev_;
double flicker_period_;
double fixed_shutter_;
double fixed_analogue_gain_;
};
} // namespace RPiController
|
