mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
296 lines
8.3 KiB
296 lines
8.3 KiB
/* |
|
Copyright (c) 2018, Raspberry Pi (Trading) Ltd. |
|
All rights reserved. |
|
|
|
Redistribution and use in source and binary forms, with or without |
|
modification, are permitted provided that the following conditions are met: |
|
* Redistributions of source code must retain the above copyright |
|
notice, this list of conditions and the following disclaimer. |
|
* Redistributions in binary form must reproduce the above copyright |
|
notice, this list of conditions and the following disclaimer in the |
|
documentation and/or other materials provided with the distribution. |
|
* Neither the name of the copyright holder nor the |
|
names of its contributors may be used to endorse or promote products |
|
derived from this software without specific prior written permission. |
|
|
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND |
|
ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
|
WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE |
|
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY |
|
DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
|
(INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
|
LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND |
|
ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
|
(INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
|
*/ |
|
|
|
#include <stdio.h> |
|
#include <stdlib.h> |
|
#include <ctype.h> |
|
#include <string.h> |
|
#include <memory.h> |
|
#include <unistd.h> |
|
#include <stdint.h> |
|
|
|
|
|
#include "interface/vcos/vcos.h" |
|
#include "interface/mmal/mmal.h" |
|
#include "interface/mmal/mmal_logging.h" |
|
#include "interface/mmal/util/mmal_default_components.h" |
|
#include "interface/mmal/mmal_parameters_camera.h" |
|
#include "interface/mmal/util/mmal_connection.h" |
|
|
|
#include "RaspiCLI.h" |
|
#include "RaspiPreview.h" |
|
#include "RaspiCamControl.h" |
|
#include "RaspiCommonSettings.h" |
|
|
|
#ifndef GIT_COMMIT_ID |
|
#define GIT_COMMIT_ID "Not found" |
|
#endif |
|
|
|
#if (GIT_TAINTED > 0) |
|
#define TAINTED " Tainted" |
|
#else |
|
#define TAINTED "" |
|
#endif |
|
|
|
static const char *app_name; |
|
|
|
void print_app_details(FILE *fd) |
|
{ |
|
if (!app_name) |
|
app_name = "Un-named"; |
|
|
|
fprintf(fd, "\n\"%s\" Camera App (commit %s%s)\n\n", basename(app_name), GIT_COMMIT_ID, TAINTED); |
|
} |
|
|
|
void display_valid_parameters(char *name, void (*app_help)(char*)) |
|
{ |
|
print_app_details(stdout); |
|
|
|
// This should be defined in the main app source code |
|
if (app_help) |
|
(*app_help)(name); |
|
|
|
// general settings |
|
raspicommonsettings_display_help(); |
|
|
|
// Help for preview options |
|
raspipreview_display_help(); |
|
|
|
// Now display any help information from the camcontrol code |
|
raspicamcontrol_display_help(); |
|
|
|
fprintf(stdout, "\n"); |
|
} |
|
|
|
|
|
void get_sensor_defaults(int camera_num, char *camera_name, int *width, int *height ) |
|
{ |
|
MMAL_COMPONENT_T *camera_info; |
|
MMAL_STATUS_T status; |
|
|
|
// Default to the OV5647 setup |
|
strncpy(camera_name, "OV5647", MMAL_PARAMETER_CAMERA_INFO_MAX_STR_LEN); |
|
|
|
// Try to get the camera name and maximum supported resolution |
|
status = mmal_component_create(MMAL_COMPONENT_DEFAULT_CAMERA_INFO, &camera_info); |
|
if (status == MMAL_SUCCESS) |
|
{ |
|
MMAL_PARAMETER_CAMERA_INFO_T param; |
|
param.hdr.id = MMAL_PARAMETER_CAMERA_INFO; |
|
param.hdr.size = sizeof(param)-4; // Deliberately undersize to check firmware version |
|
status = mmal_port_parameter_get(camera_info->control, ¶m.hdr); |
|
|
|
if (status != MMAL_SUCCESS) |
|
{ |
|
// Running on newer firmware |
|
param.hdr.size = sizeof(param); |
|
status = mmal_port_parameter_get(camera_info->control, ¶m.hdr); |
|
if (status == MMAL_SUCCESS && param.num_cameras > camera_num) |
|
{ |
|
// Take the parameters from the first camera listed. |
|
if (*width == 0) |
|
*width = param.cameras[camera_num].max_width; |
|
if (*height == 0) |
|
*height = param.cameras[camera_num].max_height; |
|
strncpy(camera_name, param.cameras[camera_num].camera_name, MMAL_PARAMETER_CAMERA_INFO_MAX_STR_LEN); |
|
camera_name[MMAL_PARAMETER_CAMERA_INFO_MAX_STR_LEN-1] = 0; |
|
} |
|
else |
|
vcos_log_error("Cannot read camera info, keeping the defaults for OV5647"); |
|
} |
|
else |
|
{ |
|
// Older firmware |
|
// Nothing to do here, keep the defaults for OV5647 |
|
} |
|
|
|
mmal_component_destroy(camera_info); |
|
} |
|
else |
|
{ |
|
vcos_log_error("Failed to create camera_info component"); |
|
} |
|
|
|
// default to OV5647 if nothing detected.. |
|
if (*width == 0) |
|
*width = 2592; |
|
if (*height == 0) |
|
*height = 1944; |
|
} |
|
|
|
void set_app_name(const char *name) |
|
{ |
|
app_name = name; |
|
} |
|
|
|
const char *get_app_name() |
|
{ |
|
return app_name; |
|
} |
|
|
|
|
|
/** |
|
* Connect two specific ports together |
|
* |
|
* @param output_port Pointer the output port |
|
* @param input_port Pointer the input port |
|
* @param Pointer to a mmal connection pointer, reassigned if function successful |
|
* @return Returns a MMAL_STATUS_T giving result of operation |
|
* |
|
*/ |
|
MMAL_STATUS_T connect_ports(MMAL_PORT_T *output_port, MMAL_PORT_T *input_port, MMAL_CONNECTION_T **connection) |
|
{ |
|
MMAL_STATUS_T status; |
|
|
|
status = mmal_connection_create(connection, output_port, input_port, MMAL_CONNECTION_FLAG_TUNNELLING | MMAL_CONNECTION_FLAG_ALLOCATION_ON_INPUT); |
|
|
|
if (status == MMAL_SUCCESS) |
|
{ |
|
status = mmal_connection_enable(*connection); |
|
if (status != MMAL_SUCCESS) |
|
mmal_connection_destroy(*connection); |
|
} |
|
|
|
return status; |
|
} |
|
|
|
/** |
|
* Checks if specified port is valid and enabled, then disables it |
|
* |
|
* @param port Pointer the port |
|
* |
|
*/ |
|
void check_disable_port(MMAL_PORT_T *port) |
|
{ |
|
if (port && port->is_enabled) |
|
mmal_port_disable(port); |
|
} |
|
|
|
/** |
|
* Handler for sigint signals |
|
* |
|
* @param signal_number ID of incoming signal. |
|
* |
|
*/ |
|
void default_signal_handler(int signal_number) |
|
{ |
|
if (signal_number == SIGUSR1) |
|
{ |
|
// Handle but ignore - prevents us dropping out if started in none-signal mode |
|
// and someone sends us the USR1 signal anyway |
|
} |
|
else |
|
{ |
|
// Going to abort on all other signals |
|
vcos_log_error("Aborting program\n"); |
|
exit(130); |
|
} |
|
|
|
} |
|
|
|
/** |
|
* Convert a MMAL status return value to a simple boolean of success |
|
* ALso displays a fault if code is not success |
|
* |
|
* @param status The error code to convert |
|
* @return 0 if status is success, 1 otherwise |
|
*/ |
|
int mmal_status_to_int(MMAL_STATUS_T status) |
|
{ |
|
if (status == MMAL_SUCCESS) |
|
return 0; |
|
else |
|
{ |
|
switch (status) |
|
{ |
|
case MMAL_ENOMEM : |
|
vcos_log_error("Out of memory"); |
|
break; |
|
case MMAL_ENOSPC : |
|
vcos_log_error("Out of resources (other than memory)"); |
|
break; |
|
case MMAL_EINVAL: |
|
vcos_log_error("Argument is invalid"); |
|
break; |
|
case MMAL_ENOSYS : |
|
vcos_log_error("Function not implemented"); |
|
break; |
|
case MMAL_ENOENT : |
|
vcos_log_error("No such file or directory"); |
|
break; |
|
case MMAL_ENXIO : |
|
vcos_log_error("No such device or address"); |
|
break; |
|
case MMAL_EIO : |
|
vcos_log_error("I/O error"); |
|
break; |
|
case MMAL_ESPIPE : |
|
vcos_log_error("Illegal seek"); |
|
break; |
|
case MMAL_ECORRUPT : |
|
vcos_log_error("Data is corrupt \attention FIXME: not POSIX"); |
|
break; |
|
case MMAL_ENOTREADY : |
|
vcos_log_error("Component is not ready \attention FIXME: not POSIX"); |
|
break; |
|
case MMAL_ECONFIG : |
|
vcos_log_error("Component is not configured \attention FIXME: not POSIX"); |
|
break; |
|
case MMAL_EISCONN : |
|
vcos_log_error("Port is already connected "); |
|
break; |
|
case MMAL_ENOTCONN : |
|
vcos_log_error("Port is disconnected"); |
|
break; |
|
case MMAL_EAGAIN : |
|
vcos_log_error("Resource temporarily unavailable. Try again later"); |
|
break; |
|
case MMAL_EFAULT : |
|
vcos_log_error("Bad address"); |
|
break; |
|
default : |
|
vcos_log_error("Unknown status error"); |
|
break; |
|
} |
|
|
|
return 1; |
|
} |
|
} |
|
|
|
|
|
uint64_t get_microseconds64() |
|
{ |
|
struct timespec spec; |
|
uint64_t us; |
|
|
|
clock_gettime(CLOCK_MONOTONIC_RAW, &spec); |
|
|
|
us = spec.tv_sec * 1000000ULL; |
|
us += spec.tv_nsec / 1000; |
|
|
|
return us; |
|
}
|
|
|